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PURPOSE 


The purpose of this document is to specify the equations 
necessary to perform- the guidance, navigation and control onboard computa- 
tion functions for the space shuttle orbiter vehicle. This equations 
document will: ' (1) establish more specifically, than on a functional 
level, the GN&C computational requirements for computer sizing, (2) provide 
GN&C design equations specification to develop demonstration software for 
hardware feasibility testing, and (3) define the hardware interface 
requirements with the GN&C subsystem software • The document will provide 
a standard of connnunicatlon of information concerning the GN&G equations, 
and will provide a means of coordination of GNSC equation developmeht. 


vii 



SCOPE 


This is Volume- III of the document which defines .the Guidance, 
Navigation and Control (GN&C) design equations • sequencing and interfaces 
for the computations required in the -GN&C 'Subsystem for all mission 
phases of the Shuttle Orblter • flight.. ‘The equations are intended to- 
satisfy the functional requirements specified in Reference a. ' This ‘ 
document, will describe in mathematical, logical, and operational language 
all the details necessary to' initiate and carry out the design of the 
required computer modules (subprograms) for the GN&C function's. 

The document will be organized into six volumes. Volume I 
contains Sections 1 through '8, which provide introductory information, icor 
the document. Volume II contains the current detailed equations for the 
preflight, boost, separation, orbit Insertion and ascent abort phases of 
the Orbiter operation. Detailed equations for orbital operations of the 
Orbiter, which include the orbital coast, orbital powered flight, rendez- 
vous, station keeping, docking and undocking, and docked operations phases, 
are presented in Volume III. Volume IV contains the current detailed 
equations for the deorbit and entry, transition, cruise and ferry, approach 
and landing, and horizontal takeoff phases of the Orbiter. Also, this 
volume will contain the equations for communications and pointing functions 
and the failure detection function. For this issue of the document, only 
Volumes I through IV are being published. In future issues, Volume V will 
contain the detailed flow diagrams for the equations. For the initial 
issue, the flow diagrams for the approved equations are included with the 
equations in Volumes II, III or IV. For future issues, the constants used 
in the equations will be summarized in Section 11 and the GN&C parameters 
and variables which can be entered or called via the keyboard will be 
enumerated in Section 12. These two sections will be contained in 
Volume. VI of the document. 



APPLICABILITY 


This document is applicable to the Guidance, Navigation, and 
Control (GN&C) Subsystem of the Electronics System of the Space Shuttle 
Orbiter Vehicle.. It is applicable to the definition of the shuttle 
computational requirements for the subsystem listed above. It is applicable 
to the Phase B and Phase C subsystem development. It defines the Manned 
Spacecraft Center Guidance and Control Division Inhouse sutdy baseline 
equations design. 



9.6 ORBITAL COAST 


The following GN&C software functions are envisioned for the orbital 
coast phase: 

Sensor Alignment and Calibration 

1* Perform, automatic calibration of sensors and compute 
compensation values’ during coasting orbital flight. 

2. Perform automatic sensor pointing and alignment during 
coasting orbital flight. 

Orbit Navigation 

3. Advance inertial vector with conic solutions from an- 
initial state to a final state as a function of time 
or anomaly, 

4 Augment conic state advancement with numerical 

integration to account for .complex gravity potential 
mode'is . 

♦ Reduce uncertainties in inertial state by accepting 
and processing data from navigation sensors (ground 
beacons, radar altimeter). 

Attitude Control 

6. Maintain attitude-hold about a desired orientation. 

7. Provide attitude rate-hold about a desired rate for 
orbital rate control, station keeping, passive thermal 
control or other constant-rate maneuvers. 

8. Provide semi-automatic control by initializing attitude 
hold following manual maneuvers. 

9. Implement minimum-impulse jet firings when required 

■ by the autopilot or selected by the crew for manual control. 

10. Maintain attitude for target visibility at crew and radar 
locations during the coast periods of rendezvous, station 
keeping and docking approach. 

9.6.1 Orbital Navigation 
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9. 6. 1.1 Conic State Extrapolation 


1 . INTEODUCTION 


The Conic State Extrapolation Routine provides the capabil- 
ity to conically extrapolate any spacecraft inertial state vector either 
backwards or forwards as a function of time or as a function of 
transfer angle. It is merely the coded form of two versions of the 
analytic solution of the two-body differential equations of motion of 
the spacecraft center of mass. Because of its relatively fast compu- 
tation speed and moderate accuracy, it serves as a preliminary 
navigation tool and as a method of o'btaining quick solutions for tar- 
geting and guidance functions. More accurate {but slower) results 
are provided by the Precision State Extrapolation Routine. 
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r(t) 

s 


Semi-major axis of conic 
First conic parameter (£^ • Vq ) / 

o 

Second conic parameter ( - 1) 

Third conic parameter ( r^ ) 

Power series in | defined in text 
Eccentric anomaly 
True anomaly 

Hyperbolic analog of eccentric anomaly 
Counter 

Semilatus rectum of conic 
Normalized semilatus rectum (p/ r^) 

Period of conic orbit 
Magnitude of r^ 

Inertial position vector corresponding to initial time 
*0 

Magnitude of r (t) 

Inertial position vector corresponding to time t 

Switch used in Secant Iterator to determine whether 
secant method or offsetting will be performed 
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9. 6. 1.1 Conic State Extrapolation (continued) 


S .C5 ) 


Power series in f defined in' text 


t 


Final time ( end of time interval through which an 
extrapolation is made ) 






Initial time { beginning of time interval through which 
an extrapolation is to be made } 

Specified transfer time interval 

Value of the transfer time interval calculated in the 
-Universal Kepler Equation as a function of x and the 
conic parameters 


(t - tfl Previous value of (t ~ tQ 


(t - tp 'The "i-th" value of the transfer time interval calcula 

ted in the Universal Kepler Equation as a function of 
the "irth" value x. of x and the conic parameters 

%RR Difference between specified time interval and that 

calculated by Universal Kepler Equation 




v<t) 


Magnitude of 

Inertial velocity vector corresponding to initial time 
■* 0 ' 

Inertial velocity vector corresponding to time t 


X Universal eccentric anomaly difference (independent 

variable in Kepler iteration scheme.) 

x' Previous value of x 


X 


c 


Value of X to which the Kepler iteration scheme con- 
verged 


X 


t 

c 


Previous value of x 

c 
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9. 6. 1.1 Conic State ExtrapolatloB (continued) 


X . 

min 

X 

max 


a 


0 


a 


N 


^0 


At 


max 


Ax 


e 


X 


B 


I 


The "i-th" value of x 
Lower bound on x 
Upper bound on x 

Reciprocal of semi-major axis at initial point 
Normalized semi-major axis reciprocal (Q'I’q) 

Angle from to v^ 

Maximum time interval which can be used in computer 
due to scaling limitations 

Increment in x 

Relative convergence tolerance factor on transfer 
time interval 

Convergence tolerance on independent variable -x 
Transfer angle (true anomaly increment) 

Gravitational parameter of the earth 
Product of Oq and square of x 

Coefficients of power series inversion of Universal 
Kepler Equation 


Unit vector in direction of r, 

0 

1 Unit vector in direction of v 

-Vo -I 
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9.6. 1*1 Conic State Extrapolation (continued) 


2. FUNCTIONAL FLOW DIAGRAM 

Th6 Conic State Extrapolation Eoutine basically consists of 
twp parts - one for extrapolating in time and one for extrapolating m 
transfer angle. Several portions of .the formulation are, however, 

common to the two parts, and may be arranged as subroutines on a 
computer, 

2.1 Conic State E.xtrapolation As A Function Of Time {Kepler 

Routine ) 

This routine involves a single loop iterative procedure, and 
hence is organized in three sections: initialization, iteration, and 
final computations, as shown in Fig, 1. The variable ”x" is the in- 
dependent variable in the iteration procedure. For. a given initial 
state, the variable x measures the amount of transfer along the ex- 
trapolated trajectory. The transfer time interval and the extrapolated 
state vector are very conveniently expressed in terms of ”x". In the 
iteration procedure, x is adjusted until the transfer time interval 
calculated from it agrees w^ith the specified transfer time interval 
(to within a certain tolerance). Then the extrapolated state vector 
is calculated from this particular value of "x". 

2. 2 Conic State Extrapolation As A Function Qf Trans fer Ang le 

( Theta Routine ) 

This routine makes a direct calculation (i. e. does not have 
an iteration scheme), as shown in Fig. 2. Again, the extrapolated’ 
state vector is calculated from the parameter "x". The value of "x" 
however, is obtained from a direct computation in terms of the conic 
parameters and the transfer angle 0. It is not necessary to iterate 
to determine "x", as was the case in the Kepler Routine. 
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9. 6. 1.1 Conic State Extrapolation (continued) 



Figure 1 KEPLER ROUTINE FUNCTIONAL FLOW DIAGRAM 
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Final Computations 

(Compute Extrapolated State Vector Corresponding 
To The Variable "x" ) . 


Figure 2 THETA HOUTINE FUNCTIONAL PLOW DIAGRAM 
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9. 6. 1.1 Conic State Extrapolation (continued) 


3. ROUTINE INPUT-OUTPUT 

The Conic State Extrapolation Routine has only one system 
parameter input: the gravitational parameter of the earth. Its prin~ 
cipal real-time inputs are the inertial state vector which is to be ex- 
trapolated and the transfer time interval or transfer angle through 
which the extrapolation is to be made. Several optional secondary 
inputs may be supplied in the transfer time case in order to speed 
the computation. The principal real-time output of both cases is the 
extrapolated inertial state vector. 

3. 1 Conic State Extrapolation As A Function of Transfer Time 

Interval (Kepler Routine) 


Input Parameters 


Sys tern 


jUg Gravitational parameter of the earth ( Product of 

earth's mass and universal gravitational constant). 

Real-Time (Required) 

(^, ^) : Inertial state vector which is to be extrapolated 

(corresponds to time t^). 

(t - t^ ) : Transfer time interval through which the extrapola- 

tion is to be made. 

Real-Time (Optional) 

X : Guess of independent variable corresponding to solu- 

tion in Kepler iteration scheme. (Used to speed con- 
vergence). 
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9. 6. 1.1 Conic State Extrapolation (coiitlnued3 




X 


C 


Value of dependent variable (the transfer time inter- 
val) in the Kepler iteration scheme, which was 
calculated in the last. iteration of the previous call to 
Kepler. 

Value of the independent variable in the Kepler itera- 
tion scheme, to which the last iteration of the 
previous call to Kepler had converged. 


Output Parameters 


(r('t),v(t)) ■ Extrapolated inertial state vector { corresponds to 
time t ) . 

(t - *0)^, Value of the dependent variable (the transfer time 

interval) in the Kepler iteration scheme, which was 
calculated in the last iteration { should agree closely 
with ( t - tg ) ) . 

Value of the independent variable in the Kepler itera- 
tion scheme to which the last iteration converged. 


3 . 2 Conic State Extrapolation As A Function Of Transfer Angl e 
{ Theta Routine ) 


Input Parameters 


System 

Mj, Gravitational parameter of the earth ( Product of 

earth's mass and universal gravitational constant). 
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9. 6. 1.1 Conic State Extrapolation (continued) 


Real-Time 




Inertial state vector which is to be extrapolated. 

Transfer angle through which the extrapolation is to 
be made. 


Output Parameters 


(r, v) 




Extrapolated inertial state vector. 

Transfer Time Interval corresponding to the conic ■ 
extrapolation through the transfer angle 6 . 
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Conic State Extrapolation (continued) 


4. ■ DESCJRIPTION OF EQUATIONS ' 

4. i Conic State Extrapolation. As A Function Of Time {Kepler 
Routine ) 

. The universal formulation of Stumpff -Herrick -Battin in 
terms of the universal eccentric anomaly difference is used. This 
variable, usually denoted by x, is defined by the relations: 


\1 a ' ( E - Ej^ ) for ellips e 


X = < \lp^(tan f/2 


tan 2 ) for parabola 


'j'^aT’CH - Hq ) -for hyperbola 


where a is the semi-major axis, E and H are the eccentric anomaly 
and its hyperbolic analog, p is the semi-latus rectum and f the true 
anomaly. The expressions for the transfer- time interval (t - t^) 
and the extrapolated position and velocity vectors (r,' v) in terms of"' 
the initial -position and velocity vectors (r^, y^) as functions of x 
are: 

{Universal Kepler Equation) 


(t-to) = 


1 

\[^- 


^ ^ 




) + {l-rQU-Q)x' 


S{a-Qx2)-^ro 



- 

r v 2 0 " 


3 “ 

£{t) = 

1 - ^-Cia^x^) 

- 'o 

£0+. 

S x^ ) 


v(t) 



r r, 


0. 


“ — 



S - X 


2 

1 - ^C(n x-^) 



r ^ 

- 


^ 
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9. 6, 1,1 Conic State Extrapolation, (continued) 


where 


and 


or. 


_ 1 _ 


r„ 


V, 




s{|) = i . - i 

3! 5! 7! 

c(^ = i -i 

2! 4! 6! 

Since the transfer time interval (t " ) is given, it is desired to 

find the x corresponding to it in the Universal Kepler Equation, and 
then to evaluate the extrapolated state .vector (r, v) expression 
using that value of x. Unfortunately, the Universal Kepler Equation 
expresses (t - t^) as a transcendental function of x rather than con- 
versely, and no power series inversion of the equation is known which 
has good convergence properties for all orbits, so it is necessary 
to solve the equation iteratively for the variable x. 

For this purpose, the secant method (linear inverse inter- 
polation/ extrapolation) is used. It merely finds the increment in 
the independent variable x which is required in order to adjust the 
dependent variable (t - t^)^ to the desired value (t - t^) based on a 
linear interpolation/ extrapolation of the last two points calculated on 
the (t - vs X curve. The method uses the formula 


<=^+1 -%> 
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9. 6. 1.1 Conic Stata Extrapolation ' (contijiuad) 


where (t “ t„) denotes the evaluation of the Universal Kepler 

V V 

Equation using the value x.. In order to prevent the scheme from 
taking an increment back into regions in which it is known from .past 
iterations that the solution does not lie, it has been found convenient 
to establish upper and lower bounds on the independent variable x 
which are continually reset during the course of the iteration as more 
and more values of x are found to be too large or too small. In ad- 
dition, it has also been found expedient to damp by 10% any incre- 
ment in the independent variable which would ( if applied ) take the 
value of the independent variable past a bound. 

. •> 

To start the iteration scheme, some initial guess x^ of the 

independent variable is required as well as a previous point (x ,, 

(t - to ') on the {t - vs x curve. If no previous point is 
available the point (0, 0) may be used as it lies on all (t " vs. 

X curves. The closer the initial guess is to the value of x corres- 
ponding to the solution, the faster the convergence will be. One 
method of obtaining such a guess x^ is to use a truncation of the 
infinite series obtained by direct inversion of the Kepler Equation 
( expressing x as a power series in (t - ) ). It must be pointed out 

that this series diverges even for "moderate" transfer time inter- 
vals {t “ Iq); hence an iterative solution must be used to solve the 
Kepler equation for x in the generad case, A third order truncation 
of the inversion of the Universal Kepler Equation is: 

3 

n=0 


where 


with 


'>1) 




1 


2 r. 


\I^E 




6ro ‘0 


- (1 - r 

1 






2\ 
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9. 6. 1.1 Conic State Extrapolation, (contitmed) 


4. 2 Conic State Extrapolation As A Function of Transfer Angle 
(Theta Rout ine ) 

As with the Kepler Routine, the universal formulation of 
Stumpff'-iJerrick-Battin in terms of the universal eccentric anomaly 
difference x is used' in the Theta Routine. A completely analogous 
iteration scheme 'could Have been formulated with x again as the. in- 
dependent variable and the transfer angle 6 as the dependent variable 
using Mar'scher's universaliy valid equation: 


cot 


e 




^ C (ffQ x^) 


+ cot 7 


0 


where 


and 


P - ( ) sin 7 


re 


0 


7 q = angle from ^ to v, 


^ ""'-O' 


However, in contrast to the Kepler equation, it is possible 

to invert th.e Marscher equation into a power series which can be . 

made to converge as rapidly as desired, by means of which x may be 

calculated as a universal function of the transfer angle 8 . Knowing 

X, we can directly calculate the transfer time interval (t - t„) and 

0 c 

subsequently the extrapolated state vectors using the standard 
formulae. 

The sequence of computations in the inversion of the 
Marscher Equation is as follows: 

Lei 


^ “'N ~ " ^0 


-and- 
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9 . 6 . 1-. 1 Conic State Extrapolation (continued) 


If 

Let 

or 

Let 

or 

Let 


sin d 




cos 8 


W, 


>1. letVj^ = 1. 






IWn ( 


< 1 ) 




K'’ *“n <|i/wj)2'tv^ ( 


u„ = W ( 

n n ' 


W, 


w. 


> 1 ) . 
< 1 ) 


V-n = <1 VW^[)/V^ (Wj>l) 




u 2j+l uT^ 

n j = 0 •* “^n 


where n is an integer >4. Then 




£ 


(W^ > 0) 

S (Wj<0) 


The above equations have been specifically formulated to avoid certain 
numerical difficulties. 
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9. 6, 1.1 Conic State Extrapolation (continued) 

5. DETAILED FLOW DIAGRAMS 

5 ^ 1 Conic State Extrapolation As A Function of Time (Kepler 
Routine) 

SYSTEM REAL TIME (Required) REAL TIME (Optional) 



Figure 3a KEPLER ROUTINE DETAILED FLOW DIAGRAM 
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9. 6. 1.1 Conic State Extrapolation (continued) 



Figure 3b KEPLER ROUTINE DETAILED FLOWDIAGRAM 
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Figure 3c KEPLER ROUTINE DETAILED PLOW DIAGRAM 
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Figure 3d KEPLER ROUTINE DETAILED FLOW DIAGRAM 
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9. 6. 1.1 Conic State Extrapolation (continued) 


Conic State Extrapolation As A Function of Transfer Angle 


■pTvrrpTp'p 

SYSTEM REAL-TIME 



Figure 4a THETA ROUTINE DETAILED FLOW DIAGRAM 
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9 . 6 . 1 . 1 Conic State Extrapolation (continued) 



•Figure 4b THETA ROUTINE DETAILED FLOW DIAGRAM 
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9. 6. 1.1 Conic State Extrapolation (continued) 



Figure 4c THETA ROUTINE DETAILED FLOW DIAGRAM 
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9. 6. 1.1 Conic State Extrapolation (continued) 

5-3 Subroutines Used By The Transfer Time or Transfer Angle 
Conic Extrapolation Routines 

5. 3. 1 Universal Kepler Equation 


SYSTEM REAL-TIME 



Figure 5 UNIVERSAL KEPLER EQUATION DETAILED PLOW DIAGRAM 
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9 . 6 . 1 . 1 Conic State Extrapolation (continued) 
5,3,2 Extrapolated State Vector 


system real time 



figure 6 EXTRAPOLATED STATE VECTOR EQUATION 
DETAILED FLOW DIAGRAM 
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5. 3. 4 Marscher Equation Inversion 



Figure 8a MARSCHER EQUATION INVERSION DETAILED FLOW DIAGRAM 
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Figure 8b MARSCHER EQUATION INVERSION DETAILED PLOW DIAGRAM- 
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9. 6. 1.1 Conic State Extrapolation (continued) 


6, supplementary information 

The analytic expressions for the Universal Kepler Equation 
and the extrapolated position and velocity vectors are well known and 
are given fay Battin ( 1964 ), Battin also outlines a Newton iteration 
technique for the solution of the Universal Kepler Equation; this tech- 
nique converges somewhat faster than the secant technique but 
requires the evaluation of the derivative. It may be shown that if the 
derivative evaluation by itself takes more than" 44% of the computa- 
tion time used by the other calculations in one pass through’ the loop-, 
then it is more efficient timewise to use the secant method, 

Marscher's universal equation for cot 0/ 2 was derived by 
him in his report (Marscher, 1965), and is the generalization of his 
"Three -Cotangent" equation; 

r (B-E) 

. cot L =_iL_ cot — ^ + cot -v_ 

2. ^fpai , 2’ ° 

Marscher has also outlined in the report an iterative method of ex- 
trapolating the state based on his universal equation. The inversion 
of Marscher's universal equation was derived by Robertson (1967a), 

Krause organized the details of the computation in both 

routines. 

A derivation of the coefficients in the inversion of the Uni- 
versal Kepler Equation is given in Robertson (1967 b) and Newman 
(1967). 
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9, 6. 1.1 Conic State Extrapolation (continued) 
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9. 6. 1.2 Precision State and Filter Weighting Matrix 
Extrapolation (continued) . 

1. INTRODUCTION 

The Precision State and Filter Weighting Matrix Extrapola- 
tion Routine provides the capability to extrapolate any spacecraft 
geocentric state vector either backwards or forwards in time through 
a force field in which all significant perturbation effects (such as the 
earth’s oblateness, the attraction of the sun and moon, and atmos- 
pheric drag) have been included, as well as the earth's dominant 
central-force attraction. The Routine also provides the capability of 
extrapolating the filter- weighting matrix along the precision trajec- 
tory. This matrix, which is also known as the "W-matrix", contains 
statistical information relative to the accuracies of the state vectors 
and certain other quantities. 

The routine is merely a coded algorithm for the numerical 
solution of modified forms of the basic differential equations which 
are satisfied by the geocentric state vector of the spacecraft's center 
of mass and by the filter -weighting matrix, namely 


and 


Q ^ "P 

— r(t) + ^ r(t} = ^(t) 

r^t)~ 


— W(t) . F(t) W(t). 
dt 


where (t) is the vector sum of all the perturbing accelerations, 
and F(t) is a matrix containing the gravity gradient matrix as one of 
its sub -blocks. 

Because of its high accuracy and its capability of extrapolat- 
ing the filter weighting matrix, this routine serves as the computational 
foundation for precise space navigation. It suffers from a relatively 
slow computation speed in comparison with the Conic State Extrapola- 
tion Routine. 
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9. 6. 1.2 Precision State and Filter Weighting Matrix 
Extrapolation (continued) 


a^(t) 

^DRAG 

^dMOON 

^OBL 

^SUN 

CjjA/M 

^22 

( cos ^ ) 
D 

E (t) 
n 

f(q) 

•^DRAG 

^SM 

f 

W 

G(t) 

h 


NOMENCLATURE 

Total perturbing acceleration at time t 

Perturbing acceleration due to atmospheric drag 

Perturbing acceleration due to moon’s gravitational 
attraction . 

Perturbing acceleration due to earth's oblateness 

Perturbing acceleration due to sun’s gravitational 
attraction 

Spacecraft drag constant 

Constant describing earth's oblateness 

Cosine of colatitude of spacecraft 

Dimension of Filter Weighting Matrix (D = 0, 6, 7, 8, 9 ) 

Covariance matrix of dimension n 

Special function of q defined in text 

Flag to indicate whether drag perturbations are-to be 
included 

Flag to indicate whether sun and moon perturbations 
are to be included 

Flag controlling whether state or filter-weighting 
matrix integration is being performed (used only 
internally in routine ) 

Gravity Gradient Matrix 

Altitude 
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9. 6.1. 2 

Ig Three-dimensional Identity Matrix 

Jg. Jg. Constants describing earth's oblateness 

Matrices of constants describing earth's atmospheric 
density 

P|( cos (ft ) Derivative of i-th Legendre polynomial 

<1 Special function of r and 5 defined in text 

Qjyi; Special function of r and r^^ defined in text 

' Qg Special function of t and r^g defined in text . 

Geocentric position vector at time t^ 
r (t) Geocentric position vector at time t 


Precision State and Filter Weighting I&trix 
Extrapolation, (continued! 



-J 

^MC 

’^SC 



Magnitude of geocentric position vector 

Reference conic position vector at time t 

Magnitude of reference conic position vector at time t 

Mean equatorial radius of the earth 

Position vector of moon with respect to earth 

Position vector of sun with respect to earth 

Intermediate values of r 

Distance of spacecraft from moon 

Distance of spacecraft from sun 

Constant describing earth's oblateness 

Initial time point 
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9 .6. 1.2 PxBcision Sts.t6 and Filter Weighting Matrix 
Extrapolation (continued) 





V (t) 

—con ' 


-rel 



W(t) 


w. 
— 1 


yE 

=^E 

max 


At 


At 


max 


At„ 


nom 


Time to which it is desired to extrapolate { r^. ) 

and optionally W^. 

Exospheric temperature 

Geocentric velocity -vector at time t^ 

Reference conic velocity vector at time t 

Yelocity vector of spacecraft relative to the atmos- 
phere 

Filter Weighting Matrix at time t^ 

Filter Weighting .Matrix at time t 

Three-dimensional column vectors into which the 
W -matrix is partitioned 

First component of r in earth-fixed coordinates 

Second component of ^ in earth-fixed .coordinates 

Third component of r in earth-fixed coordinates 

Position deviation vector of true position from 
reference conic position at time t 

Maximum value of j^j permitted (used as rectifica- 
tion criterion ) 

Time -step size in numerical integration of differential 
equation 

Maximuin permissible time-step size 
Nominal integration time-step size 
Time convergence tolerance criterion 


9,6-36 



9,. 6.1. 2 Precision State and Filter .Weighting Matrix 
Extrapolation (continued) 


e(t) 

27(t) 

,Xg 

^E- 

V {.t ) 


V 


max 


p (r) 

4 


VE 


ir 


ix' iy' iz- 


Error in the estimate of the position vector 

Error in.the estimate of the velocity vector 

Local hour angle of the sun 

■ E arth ' s gravitational p arameter 

Moon's gravitational parameter 

Sun's gravitational parameter 

Velocity deviation vector of true velocity from 
reference conic velocity at time t 

Maximum value of [y j permitted (used as rectifica- 
tion criterion) 

Atmospheric density at r 

Geocentric latitude 

Angular rotation rate of earth 

Unit vector in the direction of r 

Earth-fixed vectors (1, 0, 0), (0, 1, 0),(0, 0, 1) 
transformed into reference coordinates 
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9. 6.1. 2 Precision State and Filter .Weighting Matrix 
Extrapolation fri-intiTniP/l) 

2. FUNCTIONAL FLOW DIAGRAM 


The Precision State and Filter Weighting Matrix Extrapola- 
tion Routine performs its functions by integrating modified forms of 
the basic differential equations at a sequence of- points separated by 
intervals known as time -steps, which are not necessarily of the same 
size. The routine automatically determines the size to be taken at 
each step. In close earth orbit about 21 steps are taken per trajectory 
revolution. 

As shown in Fig. 1, the state vector and (optionally) the 
filter-weighting matrix are updated one step at a time along the pre- . 
cision trajectory until the specified overall transfer time interval is 
exactly attained. (The size of the last time-step is adjusted as neces- 
sary to make this possible. ) 
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9. 6.1. 2 Precision State and Filter Weighting Matrix 
Extrapolation (continued) * ; 


ENTER 



Figure 1 FUNCTIONAL FLOW DIAGRAM,PRECISION STATE 

AND FILTER WEIGHTING MATRIX EXTRAPOLATION 
ROUTINE 
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9. 6.1. 2 Precision State and Filter Weighting Matrix 
Extrapolation (continued') 

3. PROGRAM INPUT -OUTPUT 

The Precision State and Filter. Weighting Matrix Extrapola- 
tion Routine has the following input and output parameters: 


System 




E 


•^ 2 " 

^ 2 -’ ®22 


(TBD) 

(TBD) 


Mp. 


CqA/M 


E 


Input Parameters 

Gravitational parameter of the earth 
Constants describin'g the earth's oblatenes's 

Constants describing the sun's motion 

Constants describing the moon's motion 

Matrices of constants describing the earth's atmos- 
pheric -density 

Spacecraft drag constant 

Angular rotation rate of the earth 


Real-Time 






Geocentric state vector to be extrapolated 

Time associated with (r^, and 

Time to which it is desired to extrapolate ( r_, v„ ) 
and optionally W^, 

Filter Weighting (W ) matrix to be extrapolated 
( optional) 


■D 

^SM 

^DRAG 


Dimension of W-matrix ( 0, indicates omit W -matrix) 

Flag to indicate whether sun and moon perturbations 
are to be included 

Flag to indicate whether drag perturbations are to be 
included 
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9.6.1. 2 Precision State and- Filter Weighting .Matrix 
Extrapolation rc-n-ntiruipti) " 

Output Parameters 

^ Extrapolated geocentric state vector 
W ( tp ) Extrapolated filter -weighting matrix 
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9* 6.x. 2 Precision Stmts and FiXter Weighting Matrix 
Extrapolation (continued) 


4. DESCRIPTION OF EQUATIONS 

4. 1 Precision State Extrapolation Equations 

Since the perturbing acceleration is small compared with the 
central force field, direct numerical integration of the basic differ- 
ential equations of motion- of the spacecraft state vector is inefficient. 
Instead, a technique due to Encke is utilized in which only the devia- 
tions of the state from a reference conic orbit are numerically integrated 
The positions and velocities along the reference conic are obtained 
from the Kepler routine. 

At time t^ the position and velocity vectors, r^ and ^ , define 
an osculating conic orbit. Because of the perturbing accelerations, 
the true position and velocity vectors r (t) and v(t) will deviate as 
time progresses from the conic position and velocity vectors r (t) 
^on^^^ which have been conically extrapolated from m and v 
Let ^ 


6 (t) = r(t) - r^^^(t) 
^(t) = v(t) - v^^^(t) 


be the vector deviations. It can be shown that the position deviation 
^(t) satisfies the differential equation 


— 6(t) + 
dt2~ 


‘E 


r “ (t) 
con ' ^ 


f (q) r (t) + 6 (t) 


^(t) 


with the initial conditions 


^(to) = 0, y(tQ) = 0 


where 


(6 - 2r) - 6 

. f(q) - q 

^ 1 + U q )^/2 
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9.6.1. 2 Precision State and Filter Weighting Matrix 
Extrapolation (continued) 


and O) is the total perturbing acceleration. The term 

f (q) r (t) + 5_{t ) J 

must remain small, i. e. of the same order as ^ ( t), if the method 
is to be efficient. As the deviation vector £(t) grows in magnitude, 
this term will eventually increase in size. When 



|6(t)| > 0.01|r^^„(t)| or |r(t)| > 0,01|v^^^(t) 


or when 


a new osculating conic orbit is established based on the latest preci- 
sion position and velocity vectors r (t) and v(t), the deviations 6^(t) 
and p(t) are zeroed, and the numerical integration of 6 (t) and j^it) 
continues. The process of establishing a new conic orbit is called 
rectification. 


4.2 Explicit Form of the Perturbing Acceleration 

The perturbing acceleration is the vector sum of four 

separate accelerations, namely those due to the earth's oblateness 
a^OBL> the gravitational attractions of the sun ^^id moon 

a^MoON^^^’ and the earth's atmospheric drag 


^ ^ ^ = ^OBL ^ ^SUN ^MOON ^ ^DRAG* 
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9. 6. 1.2 Precision State and Filter Weighting Matrix 
Extrapolation (continued) 


4. 2.1 The earth oblateness acceleration is given by the truncated 
spherical harmonic expansion involving the zonal terms ^4' 

and the sectorial term 


"E I V' 7 (■'e/ 


( cos (^ ) - P! ( cos <ft ) 2 


— z 


r„ 2 
+ 3 (-5) 


^2xg ^ 2yg ^ ^ 

' i:x -y 3 -r^ ^22 

^ jp u 2P 


4. T + !^ 1 1 ^ s 

r r 


where 

' is the unit position vector in reference coordinates, 

l^j ly< 2^ earth-fixed vectors {1,0,0), (0,1,0), 

(0,0,1) transformed into reference coordinates, 

Xg, y^, Zj, are the components of r in earth-fixed coordin- 
ates, 

cos </• = ij. ' iz' 

is the mean equatorial radius of the earth, 

and where 

( cos <f) ) 

P^ ( cos (J ) 

( cos ^ ) 

P^ ( cos ^ ) 

are the derivatives of the Legendre polynomials,' 


= 3 cos 

= I ( 15 cos^ - 3 ) 

= I ( 7 cos - 4P^ ) 

= ^ ( 9 cos P^ - 5Pp 
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-9. 6. 1.2 -Precision State and Filter Weighting Matrix 
Extrapolation (continued) 


4. 2. 2 The gravitational accelerations due to the sun and moon on a 
spacecraft in earth orbit are given by: 








^MC 



^ -EM 



where r^g and-r^.^^ are the position vectors of the sun and moon with 
respect to the earthy and are distances of the spacecraft 

from the-sun and moon ~ ^IeS’ -MC ” — " 
arguments Qg and are computed from 


‘Is 


( r - 2rj,g ) ' r 



‘Im = 2 

‘ ' ^EM 

and a^df (qj^) are calculated from the equation for the function 

f given itiSeption 4. 1. 

4. 2. 3 The drag acceleration is given by; 

C A 

^EAG = 

where (C^A/ M) is a constant depending on the coefficient of drag, 
and the cross sectional area and mass of the spacecraft, p (r) is the 
density of the atmosphere at the point in question, and is the 
velocity vector of the spacecraft relative to the atmosphere and is 
computed' by assuming the atmosphere is rotating at the same angular 
velocity as the earth, i. e. 
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9. 6.1. 2 Precision State and Filter Weighting Matrix 
Extrapolation (continued) 


= X - “E 

where v is the geocentric velocity, 1^ the unit vector of the earth's 
north pole expressed in reference coordinates, and is the angular, 
rotation rate of the earth. The density p is obtained from an approx- 
imation to the Jacchia density model in the form of two binomial fits; 
the exospheric temperature is approximated by a binomial in latitude 
and local hour angle of the sun, and the density is then approximated 
by a binomial in the exospheric temperature and the altitude. 
Specifically, Let <j), Xg, h, be the geocentric latitude, local hour 
angle of the sun, altitude and exospheric temperature respectively at 
the position r; and let 


0 ' 


h' 


<i> - 


h - hg. 



T' = 

oc 


T 

oc 


- T 


be "adjusted" values of these parameters. Further, let h', 

T' denote the vectors 


1 


1 


1 


1 

r 

(0')^ 

(0’)^ 

, ^ = 

(X-g)2 

{X's)3 

, h' = 

h' 

(h>)^ 

(h-)^ 

, T' - 

T' 

CC 

• 


• 


• 


• 

• 


• 


• 


• 

• 


• 


* 


• 

_ 


— - 


_ 


__ 


whose components are the various powers of the adjusted parameters. 
Then the double binomial approximation to the atmospheric density 
may be written as; 


= ^ p = ( T' (h' ) 
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9. 6. 1.2 Precision State and Filter Weighting Matrix 
Extrapolation (continued^ 


where M,p and are rectangular matrices whose elements are con- 
stants, For an altitude range of 60 nautical miles, it has been found 
sufficient to have and of dimension six, h' of dimention nine, and 
T; of dtoeasion four; the matrices and are thus 6 x 6 and 
4 X 9 in size. 

4.3 Filter -Weighting ( W ) Matrix Extrapolation 

The position and velocity vectors as maintained in the 
spacecraft's computer are only estimates of the true values. As 
part of the navigation technique it is necessary also to maintain sta- 
tistical data in the computer to aid in the processing of navigation 
measurements. The filter weighting W-matrix is used for this pur- 
pose. 


If 6^{t) and n (t) are the errors in the estimates of the 
position and velocity vectors, respectively, then the six-dimensional 
error covariance matrix Eg (t) is defined by: 




€ (t) e (t) 


■ \ 


n (t) e (t) 


e (t) n(t) 



n(t) r,(t)'^ 


,/ 


In certain applications it becomes necessary to expand the 
state vector and the covariance matrix to more than six dimensions 
so as to include the estimation of various other quantities such as. 
landmark locations during orbit navigation and certain instrument 
biases during co-orbiting vehicle navigation. For this purpose a nine- 
dimensional covariance matrix is defined as follows: 
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9. 6. 1.2 Precision State and Filter Weighting Matrix 
Extrapolation (continued) 


Eg(t) 



where the components of the three-dimensional vector ^ are the errors 
in the estimates of three variables which are estimated in addition to 
the components of the spacecraft state vector. (In some navigation 
procedures, only one or two additional quantities are estimated). 

Finally if the position and velocities of two separate 'space- 
craft are to be maintained simultaneously as well as the additional 
estimated quantities 3. then a fifteen dimensional covariance matrix 
(t ) is defined: 




^15 


O 


o 


Eg(t), 


Rather than use one of the covariance matrices E„, E„, or E,_ in 

6 9 In 

the navigation procedure, it is more convenient to use a matrix W^(t) 
having the same dimension n as the covariance matrix E^(t) and 
defined by 


E (t) = W (t) W 
n n n 

W^{t) is called the filter weighting matrix, and is (in a certain sense) 
the square root of the covariance matrix. 
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9*6*1. 2 Precision State and Filter Weighting Matrix 
■ Extrapolation (continued) 


Extrapolation of the six and nine -dimensional W matrices is 
made by direct numerical integration of the basic differential equa- 
tions 


— W„(t) 
dt ® 


— Wq(t) 

dt ^ 



\G(t) 

/o 

G(t) 

\o 



Wg(U 


o 

o 



Wg(t) 


where Ig is the 3x3 identity matrix and G (t) is the 3x3 gravity 
gradient matrix 


G(t) 


r^(t) 


3r(t) r(t)'^ 


r^t)Ig 


If the W matrix is partitioned as 




Wi 

« 4 4 


-9 

-10 

» 4 • 

^17 

CO 

CD 


^6 


\ 


where the are three dimensional column vectors, then the basic 
differential equations may be written: 
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9. 6. 1.2 Precision State and Filter Weighting Matrix 
Extrapolation (continued) 


dt 


w.(t) 




— W^gCf) =G(t)W.(t) 
at 


> i = 0, 1. . . . , 8 




Hence, the extrapolation of the Wg matrix may be accomplished by 
successively integrating the second order vector differential equa- 
tions 


(t) = G (t) w. (t) 


Oi Ij *t.j 8, 


dt 


or equivalently 

d^ ,,v 
— w • ( t ) = 

dt^ r^(t) 


r(t) . w.(t) 


r(t) - r-^Ct) 


■) 


i = 0, 1, . , 8 


and utilizing the identities; 


-i+18 ^ ^ ^ ' constant 


i = 0, 1, 8 , 


The derivatives w. (t) i = 0, 1, . , . , 8 are a by-product of the 
dt 

numerical integration of the second order equations. 

Similarly, the extrapolation of the Wg matrix involves the 
same equations with the index i running only up to five { x = 0, 1, . . . , 
5), while the extrapolation of the matrix is merely the separate 
extrapolation of independent Wg and Wg matrices. 
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9. 6. 1.2 Precision State and Filter Weighting Matrix 
Extrapolation (continued) 


4. 4 Numerical Integration Method 

The extrapolation of inertial state vectors and filter weight- 
ing matrices requires- the numerical solution of t-wo second- order 
vector differential equations, which are special cases of the general 
form . 

.2 

— y(t) = f(t, y(t), z(t)) 
dt" ■ “ “ ■ 


where 



Nystrom's standard fourth-order method is utilized to numerically 
solve this equation. The algorithm for this method is: 


in+l = 

6 

D 

k, =f(t,y,z) 

—1 — ' n' i-n -n 

^ (t +i-At, V +lz At +lk,{At)^, z„ + ^k. At) 

where 


and 


t 


n+1 


t + At 
n 


e 
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9. 6. 1.2 Pr.ecision State and Filter Weighting Matrix 
Extrapolation (continued). 


As can be seen, the method requires four evaluations of 
f_(t, z) per integration step At as does the classical fourth-order 
Runge-Kutta method when it is extended to second -order equations. 
However, if ^is independent of then Nystrom's method above only 
requires three evaluations per step since ^ = ^2. (Runge-Kutta's 
method will still require four). 

The integration time step At may be varied, from step to 
step. The nominal integration step- size is 

^^nom ^ ^ ^con ^ 

with K = 0.3. The actual step size is however limited to a maximum 
of 

At = 4000 seconds. 

Also, in-the last step, the actual step size is taken to be the interval 
between the end of the previous step and the desired integration end- 
point, so that the extrapolated values of the state or W -matrix are 
immediately available. Thus the integration step-size At is given by 
the formula 


At = + minimum {I t™- t|. At , At ) 

- 'I E I' nom' max' 

where t^is the desired integration end-point and t is the time at the 
end of the previous step. The plus sign is used ii forward extrapola- 
tion is being performed, while the negative sign is used in the back- 
dating case. 
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9. 6. 1.2 Precision State and Filter Weighting Matrix 
Extrapolation (continued) 


5. DETAILED FLOW DIAGRAMS 

This section contains detailed flow diagrams of the Preci- 
sion State and Filter Weighting Matrix Extrapolation Routine. 
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Figure 2a DETAILED FLOW DIAGEAM 
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9.6.1. 2 Pi^eclsion State and Pilter Weighting Matrix 



Figure 2b DETAILED PLOW DIAGRAM 
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9.6>X«2 Precision SCeie and Weighting loaEirix 
Extrapolation (continued) 





Pigure 2c DETAILED PLOW D I AGE AM 
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6. 1.2 Precision State and Filter Weighting Matrix 
Extrapolation rconti-rmed^ 



Figure 2d DETAILED PLOW DIAGRAM 
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9. 6, 1.2 Precision State and Filter Weighting Matrix 
^trapolation (continned'^ 

6. SUPPLEMENTARY INFORMATION 

Encke's technique is a classical method in astrodynamics 
and is described in all standard texts, for example Battin {1964>). 

The f ( q) function used in Encke's technique and in the lunar-solar 
perturbing acceleration computations has generally been evaluated by 
a power series expansion; the closed form expression given here was 
derived by Potter, and is described in Battin (1964). 

The oblateness acceleration in terms of a spherical. harmonic - 
expansion may be calculated in a variety of ways; three different 
algorithms are given in Gulick (1970). For low order expansions-, 
especially those involving mostly zonal terms, the formulation pre- 
sented in Section 4 is generally superior computation-time-wise, as 
only the non-zero terms enter into the calculation. The general ex- 
pression for the zonal terms. is given by Battin (1964), while Zeldin 
and Robertson (1970) give explicit analytic expressions for each of- ’ 
the tesseral terms up through fifth order; hence additional terms ' 
may easily be included in the oblateness acceleration con- 

sulting the formulations in these two references. 

The lunar-solar perturbing acceleration formulation. has 
also been described by Battin ( 1964 ) and many other texts. 

The drag acceleration utilizes the standard fundamental ex- 
pression in terms of the C^^A/ M constant, the density, and the velocity 
with respect to the atmosphere. The double binomial approximation 
to Jacchia's density model has been developed by the McDonnell- 
Douglas Corporation (1970'); the model itself is described in Jacchia 
( 1970 ). (A new model by Jacchia is about to appear). 

A full discussion of the use of covariance matrices in space 
navigation is given in Battin (1964). Potter(1963) suggested the use of 
the W-matrix and developed several of its properties . It should be noted 
that strictly the gravity gradient matrix G(t) should also include the 
gradient of the perturbing acceleration; however, these terms are so 
small that they may be neglected for our purposes. The use of only 
the conic gravity gradient, however, does not imply the W-matrix is 
being extrapolated conically. (Conic extrapolation of the W-matrix 
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9. 6.1, 2 Precision State and Filter Weighting Matrix 
Extrapolation (continued) 

can be performed by premultiplying the W -matrix by the conic state 
transition matrix, which can be expressed in closed form). Rather 
the W-matrix is here extrapolated along the precision (perturbed) 
trajectory, as can be Been from the detailed flow diagram of Section 

5. 

The Nystrom numerical integration technique was first con- 
ceived by Nystrom <1925), and.is described in all standard texts on 
the numerical integration of ordinary differential equations, such as 
Henrici (1962 ). Parametric studies carried out by Robertson (1970) 
on the general fourth -order Eunge-Kutta and Nystrom integration 
techniques indicate that the "classic" techniques are the best overall 
techniques for a variety of earth orbiting trajectories in the sense of 
minimizing the terminal position error for all the trajectories, 
although for any one trajectory a special technique can general!^ be 
found which decreases the position error after ten steps by one or 
two orders of magnitude for only that trajectory. The classical 
fourth -order Eunge-Kutta and Nystrom techniques are approximately 
equally accurate, but the latter possesses the computational advant- 
age of requiring one less perturbing acceleration evaluation per step 
when the perturbing acceleration is independent of the velocity. This 
fact has been taken into account in the detailed flow diagram of Section 
5, in that the extra evaluation is performed only when atmospheric 
drag is included. Some past Apollo experience has suggested that 
extra evaluation effect with drag is so small as to be negligible; 
further analysis will confirm or deny this for the Space Shuttle. In 
regard to step-size, the constants and the functional form of the 
nominal and maximum time-step expressions have been determined 
by Marscher { 1965 ). 
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9. 6. 1.2 Precisions State and Filter Weiphtinc Matrix 

Extrapolation (con’t)’ [ ^ 

(10) Zeldin, S, and Robertson, W,M. , 1970, Explicit Analytic 

Expressions for the Terms in a Spherical Harmonic Ex- 
pansion of tlie Gravitational Acceleration due to Oblat eness , 
MIT/DL Space Guidance Analysis Memo #4-70, May 1970. 


9 . 6.2 Sensor Calibration and Alignment (TBD) 

9.6.3 Orbital Coast Attitude Control (TBD) 
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9.7 ORBITAL POWERED FLIGHT 

The following GN&C softoare functions are envisioned ifor the orbital 
phase : 

Guidance Funct ions 


1. Perform orbit modifications targeting, or accept ground/ 
base targeting solutions as Initialization. 

2. Compute and command initial thrusting attitude. ' 

3. Coimnand orbiter maneuvering engine on. 

4. Compute velocity to be gained vector (before and during 
burn) . 

5. Provide orbit maneuver steering conmiands to autopilot. 

6. Compute time-to- cut-off and issue engine off commands. 

7. Provide- commands to null residual velocities. 

Navigation Functions 

1. Specific Force Integration - Advance the inertial state 
utilizing accelerometer measurement of thrust and. 
aerodynamic ' forces . 

2. Update inertial state from other navigation sensor data 
if available. An example is radar altimeter data. 

3. Provide coordinate transformations for state vectors 
as required. 

4. Compare state with that calculated by other vehicle 
during launch for use in decision making and possible 
updating . 

Control Functions 

1. Perform vehicle stabilization and control during TVC by 
engine glmbal commands, 

2. Provide vehicle roll stabilization during single-engine 
bums using RCS. 

3. Perform attitude-hold RCS AV maneuvers. 

4. Perform steered-attitude RCSAV maneuvers for docking 
if required. 
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5. Do eg/ trim estimation during TVC turns 


6. Make high-frequency steering estimates between guidance 
samples for docking if required. 

7 . Perform adaptive-loop gain calculation if required. 

5.7.1 Targeting (TBD) 

9.7.2 Navigation {same as Rapid Real-Time State Advancement 

During Specific Force Sensing) 

9.7.3 Guidance (TBD) 

9.7.4 Attitude Control (TBD) 
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9.8 RENDEZVOUS MISSION PHASE 

The rendezvous mission phase begins at the completion of orbit 
insertion with the computation of the rendezvous plan. During this 
coasting period of time, the mission planning software will utilize 
the rendezvous targeting routines to insure that the insertion cut-off 
conditions (i.e,, cut-off state vector) are within the rendezvous 
corridor defined by pre-mission and crew option inputs. When a 
satisfactory plan is established, the various tasks of the rendezvous 
will be assigned a preliminary schedule. The Implementation of this plan 
will represent the remainder of the rendezvous mission phase. 

The SW functions required in this mission phase are the following: 

1. Estimate relative state of target vehicle based on 
external measurements (if available) . 

2. Estimate absolute states of both shuttle and- target' 
vehicle . 

3. Target the rendezvous AV's required, their direction, 
and the time’s of ignition. 

4. Execute rendezvous maneuvers by commanding engine’s 
on, providing attitude commands during the maneuvers, 
and commanding engines off. 

5. Powered flight navigation. 

6. Provide RCS engine commands to achieve commanded attitude 
during AV maneuvers and during coast periods (digital 
autopilot) . 

7 . Provide data for failure analysis . 

8. Provide data for crew display. 

The guidance and navigation software during the burns will be the same 
as described in Orbital Powered Flight. The estimates of absolute states 
will be performed as described in Orbital Coast. 
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SPACE SHUTTLE 


GN&C SOFTWARE EQUATIOM SUBMITTAL 

Software Equation Section: Rendezvous Targeting Submittal Ho. 21 

Function : Provide targeting solutions for rendezvous 

Module No. 0G3 Function No. : 1,2, 3, 4^5, 6 (MSC 03690) • 

Submitted by^ W. H. Tempelmcm, P. M. Kachntan Co. MIT No. 7-71 
Date: Feb 1971 

NASA Contact: J, Suddath Organization: GCD 

Approved by Panel III Date : . i // a /'1 / 

Summary Description: Rendezvous targeting is concerned with selecting 

the number of maneuvers, their spacing, magnitudes and directions. These 

maneuvers and the resulting trajectory must satisfy lighting, fuel. 

communication and navigation constraints and have terminal conditions 

conducive to crew monitoring and backup procedures. 

Shuttle Configuration: This software is essentially independent of the 

shuttle configuration. 

Comments : 

(Design Status) 

(Verification Status) 

Panel Comments ; 
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9.8.1 Rendezvous Targeting 


1. INTRODUCTION 

The rendezvous of the Shuttle with the Space Station is ac- 
complished by maneuvering the Shuttle into a trajectory which inter- 
cepts the Space Station orbit at a time which results in the rendezvous 
of th-e two vehicles. The Shuttle maneuvers by intermittent thrusting 
of its rocket engines. Rendezvous targeting is concerned with select- 
ing the number of maneuvers and their spacing, magnitudes and direct- 
ions, These maneuvers and the resulting trajectory configuration 
must satisfy lighting, communication and navigation constraints and 
have a terminal configuration conducive to astronaut monitoring and 
backup maneuver procedures. In addition, the rendezvous'should • 
not use excessive'amounts of fuel, 

I- 1 Possible Maneuver Sequences 

During the Gemini and Apollo flights and in the design of the 
Skylab "rendezvous trajectories various numbers of maneuvers were 
involved in making the rendezvous. The range went from two (Apollo 
14} to six (Skylab). Rendezvous targeting is primarily concerned with 
the targeting of the maneuvers which proceed the two terminal maneuvers, 
which are targeted separately. The number of preterminal maneuvers 
involved in a rendezvous presents one way of categorizing the rendezvous 
scheme. For instance, one possible rendezvous nomenclature is 

Freterminal Rendezvous Sequences 

ZMS - Zero maneuver sequence 

SMS - Single maneuver sequence 

DMS - Double, maneuver sequence (eg, Apollo: CSi, ,CDH) 

TMS - Triple (Three) maneuver sequence 

FMS - Four maneuver sequence (eg, Skylab- NCI, NC2 
NCC, NSR) 

It would be premature to select one of the' above sequences 
as-involving an optimum number of maneuvers for the Shuttle rendezvous 
at this time as the desired targeting constraints (which are a'fiinction 
of the constraints mentioned above) have not yet been formulated. 

This report, therefore, will emphasize certain basic maneuvers to be 
used as building blocks for the Shuttle rendezvous scheme employing • 

N maneuvers. 
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9.8.1 R endezvous Targeting (continued) 

As each maneuver has its own targeting program, the above 
nomenclature can be applied to all of the above pre terminal maneuvers. 
For instance, if the first maneuver performed is a four maneuver 
sequence (FMS), it will be chronologically followed by a TMS, DMS 
and a SMS. The next maneuver will then be the first maneuver of the 
terminal phase of the rendezvous. 

1. 2 Number of Targeting Constraints Involved in the Preterminal 
Phase of Rendezvous 


The number of constraints involved in the preterm'inal 
rendezvous sequences equals the number of degrees of freedom 
implicitly contained in the sequence. To establish this number, a 
rendezvous configuration can be constructed by imposing arbitrary 
constraints until the configuration is uniquely defined, A four maneuver 
coplanar sequence is shown in Fig. 1 , followed by a coast to a 
terminal point . Using the constraints v^ (velocity magnitude), m and 
it is easy to establish that the total number involved is 12, assuming 
the time of the first maneuver has been established . Removing one 
maneuver will reduce the number of degrees of freedom by three. 

Hence, the number of constraints necessary to uniquely determine 
the maneuve r sequences are 
ZMS - 3 
SMS - 3 
DMS - 6 
TMS - 9 . 

FMS - 12 

If the above rendezvous are not coplanar rendezvous, one additional 
constraint has to be added to each sequence to allow for the out-of- 
plane component. 

If the desired number of targeting constraints falls short of 
the number of constraints required for a particular rendezvous sequence 
then the rendezvous trajectory is not uniquely defined and it-cannot be 
determined. The deficiency in constraints can be eliminated by intro- 
ducing sufficient variables to complete the determination of the rendez- 
vous trajectory and then determining values for these variables by 
optimizing the fuel used by varying the variables. This procedure, 
although not used on previous missions, might be desirable for the 
Shuttle. 
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9-8.1 Rendezvous Targeting (continued) 



Figure 1 A Possible Set of Constraints Involved in a FMS Rendezvous 



9*8.1 Rendezvous Targeting (continued) 


1. 3 Basic Preterminal Maneuvers 

Each maneuver in the above sequences can have associated 
■with it targeting constraints governing the maneuver itself, the duration 
of the coast phase following the maneuver and trajectory constraints 
defined either with respect to the active vehicle or relative to the 
passive vehicle. The possible constraints are multifarious. However, 
Apollo and Skylab utilized three basic maneuvers, each with a set of 
unique constraints. 

NP - Nominal phase maneuver 
NH - Nominal height maneuver 
NC • - Nominal coelliptic maneuver 
KL - Nominal Lamber Maneuver 

In addition, many other types of maneuvers could be defined, 
depending on the targeting constraints imposed. 


1. 3. 1. Nominal Phasing Maneuver 

The nominal phase maneuver is a horizontal maneuver which 
adjusts the active vehicle's orbit to satisfy a terminal constraint on 
phasing. This phasing constraint is generally imposed at the TPI 
point (see below), using the desired relative geometry between the 
two vehicles. Also assoicated with this maneuver is a constraint 
on the elasped time before the next maneuver. In the Apollo concentric 
flight plan NP was the first maneuver in the rendezvous sequence 
and was referred to as the CSI maneuver. In the Skylab NCI and NC2 
programs it v.^as also the first maneuver and was referred to as the 
NCI and NC2 maneuvers, respectively. 

1.3.2. Nominal Height Maneuve r 

The nominal height maneuver is a horizontal maneuver 
whose purpose is to achieve a specified differential altitude with the 
passive vehicle orbit at the time of the following maneuver, which 
also has a constraint imposed on its timing. Generally, the latter 
constraint consists of the fraction of a revolution which elapses 
between the two maneuvers. The NC2 and NCC maneuvers during the 
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9.8.1 Rendezvous Targeting (continued) 

Skylab NCI program were height maneuvers and the NCC maneuver was 
a height maneuver during the NC2 program. 

1* 3. 3, Nominal Coelliptic Maneuver 

The coelliptic maneuver computes a post maneuver velocity 
which results in coelliptic (concentric) orbits, whereby the two orbits 
maintain an approximately constant, radial separation distance. This 
maneuver generally preceeds the TPI maneuver. ' In Apollo and’ 

Skylab, CDH and NSR were the coelliptic maneuvers, respectively. 

1. 3. 4. Nominal La mbe rt Maneuver 

The Lambert maneuver computes a maneuver based on 
computing a trajectory between two position vectors with a constraint 

on the traverse time. In Apollo and Skylab, TPI and NCC were Lambert 
maneuvers. 

1- 4 Terminal Maneuvers 

The terminal phase of the rendezvous includes three maneuvers 

TPI - Terminal phase initiation 
TPM - Terminal phase midcourse 
TPF - Terminal phase final 

These maneuvers result in the rendezvous of the active vehicle with 
the passive vehicle. TPF.will be covered by documentation to be 
submitted at a latter date and is not herein considered. 

4. 1 Terminal Phase Initiation Maneuver 

The time of this maneuver is determined either by assuming 
a time or by specifying an elevation angle. This angle allows the 
maneuver time to be determined in an iterative search for the vehicle's 
relative positions which satisfies the elevation angle constraint. 

The TPI maneuver determines a trajectory which results 
in a rendezvous with the passive vehicle. This maneuver is determined 
with a precision Lambert routine. 

1>4.2 Terminal Phase Midcourse Maneuver 

This program computes a midcourse maneuver to insure that 
the active vehicle wiU intercept the passive vehicle at the time estab- 
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9.8.1 Rendezvous ^argetlng.(contiimed) 


.lished in the TPI program. The precision Lambert routine is used 
in this program as in the TPI program. 

^ Additional Maneuvers and Prograrns 

This section contains a discussion of the plane change (PC) 
maneuver and the phase match (PM) program. 

Plane Change Maneuv er 

The purpose of the plane change maneuver is to make the 
active and passive vehicle orbits coplanar. This maneuver is made 
by the active vehicle following a 90 degree central angle traverse 
from the previous maneuver, which must result in the active vehicle's 
velocity vector being coplanar with the orbital plane of the passive vehicle 
This produces a nodal point 90 degrees from the maneuver, 

1* 2. Phase Match Program 

The correct rendezvous configuration would be derived if 
the targeting programs used precision extrapolation programs 
exclusively. However, as the targeting programs generally employ 
iterative searches, the use of precision extrapolation routines will 
generaUy be rather costly from the time standpoint. For coplanar 
problems, the "phase match' technique allows the use of conic extrapola- 
tion routines without significantly degrading the accuracy of the calcula- 
tion . This technique results in updating both vehicle's states over 
the same sector of the earth's surface during the targeting program. 

As the vehicles are in approximately the same orbits, the" effects 
of the oblate earth will be the same in each orbit, resulting in an 
approximately unperturbed relative motion. 

1* 6 Organization 

The remainder of this document is divided into two main 
sections, 1) an individual description of each of the above maneuvers 
and 2) an assembly of some of these maneuvers into a four maneuver 
preterminal rendezvous requence. In addition there is a section contain- 
ing some basic subroutines used in several of the programs. 
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9.8.1 Rendezvous • Targeting ( continued) 


1. 7 Nomenclature 

The nomenclature below is a listing of the major symbols 
used in this report. It is not a complete listing due to the large 
number of basically independent programs contained in this report. 


c 

DELH 

dv 

e, 

h 


n 


P 

r 

RNCE 

s 


•V- 

X, Y, Z 

e 

T 


Iteration counter (used in Newton Eaphson iterative loop) 

Delta altitude as defined in TPI program 
Maneuver magnitude 

Elevation angle (different symbols apply in different programs) 
Height 

Number of revolutions between maneuvers 
Partial (used in Newton Eaphson iteration loop) 

Position 

Distance along orbit as defined in TPI program 

Switch 

Time 

Velocity 

Cartesian axes 

Iterative cutoff limit on the dependent variable. 

Orbital period 


Subscripts 

A 

D 

P 

H 

P 


Active 
. Desired 
Final 

Height ■ maneuver 
Passive, phasing maneuver 


The function SIGN (x) (in the TPI program this function is SGN) 
equals 1 if x is zero or a positive number; otherwise equals -1. 
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9.8.1 Rendezvous largetlng(contiiiued) 


2. MANEUVER PROGRAM DESCRIPTIONS 

The descriptions of the maneuver program are divided into 
five sections each 

1) Program objectives and general comments 
2} Program input - outputs 

3) Program description 

4) Program functional flow chart 

5) Program detailed flow chsirt 

The program descriptions contain equations only when they are of 
special significance. ,In general, few equations are listed as the maneu- 
ver programs mostly contain statements pertaining to state vector ex- 
trapolations or trivial equations. 

The functional flow charts seek to describe with words exactly 
what the detailed flow charts describe with mathematical symbols. 

The two flow charts are, thus, both self sufficient (on their respective 
levels) and self explanatory. 

2. 1 P hase Maneuver Program (NP) 

2. 1. 1. NP Program Obj ec tives 

The main objective of the Phase Maneuver NP Program is 
to compute a maneuver which will satsify a terminal phasing constraint. 
This constraint is generally imposed at the TPI point by specifying the 
desired relative geometry of the two vehicles. The geometry is 
usually defined in terms of the elevation angle (see Fig. 2) and 
a delta altitude between the passive orbit and the active vehicle at 
the TPI 'time. In addition, this maneuver must satisfy the' constraints 

1. Av^ horizontal 

2. Next maneuver occurs after transfer time nr, where n 
is specified and t is the post NP orbital period. 

Additional maneuvers, which can be independently calculated, can be 
inserted between the NP and TPI maneuvers. 
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9.8.1 Rendezvous targeting, (continued) 



1 ) If the LOS Projection on UH is Positive: 

a) When the LOS is above the Horizontal Plane 

0 < 7t/2 

b) When the LOS is below the Horizontal Plane 
3 tt/ 3 < 2r 

2 ) . If the LOS Projection on UH is Negative 

a) When the LOS is above the Horizontal Plane 
3t/ 2 < ej^< 7 t 

b) When the LOS is below the Horizontal Plane 

5T < < 3t/ 2 


Figure 2 Definition of Elevation Angle, e^^ 
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9.8.1 Rendezvous Targeting (continued)- 


The calculation of the NP' maneuver involves a Newton Raphson 
inter ation scheme to determine the magnitude of the maneuver j using 
a phasing error as the dependent variable, A functional' flow chart 
of the NP maneuver is‘ contained in Fig , 2.1,4,, 

2.1.2 NP Program Input-Output 

The required' inputs to the Phase Maneuver Program are 


—A' ^A' — P’ ^P and- passive state vectors 

at time of NP maneuver 

n Number of revolutions before next 

maneuver 

A h Desired relative altitude at TPI 

(positive if passive above active) ' 

Elevation angle (see Fig. 2 ) 

Initial guess of NP maneuver magnitude 

Time of the TPI maneuver 

The outputs to' this program are 

NP maneuver Av 

t Time of next maneuver 


TPI 




2. 1. 3. NP Program Description 

A detailed fio'w chart of the program is shown in Fig. 2. 1, 5. 

The program starts with an update of the passive state to 
the TPI time. The QRDTPI routine is then used to obtain the active 
vehicle's position vector at the TPI time. This vector defines 
the desired TPI phasing. 


After adding the guess of the NP maneuver to the active ' 
vehicle's velocity vector, the REVUP subroutine is used to obtain 
the active state at the next maneuver point. This state can then be 
updated through additional maneuvers as required, so long as the 
maneuvers are self contained, until the TPTtime is- reached. An 
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9 •8.1 Rendezvous ('continued) 


Phase Maneuver 



-Pig- 2.1,4 NP Functional Flow. Chart 
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9.8.1 Rendezvous Targeting (continued) 
















9.8.1 Rendezvous Targeting. (continued)' 


angular phasing err.or is then defined as 

. ' SIGN [ir^g X • (>lp X Vp)] cos’' (r^g- 

where r^g is the active vehicle' s position ait the TPI time. This error 
is then used in the ITER subroutine to vary the phasing, maneuver until 
the phasing, .constraint is satisfied, 

2. 2 Height Maneuver Program (NH) 

2. 2. 1 NH Program Objectives 

The objective of the height' maneuver NH program is to 
compute a maneuver which satisfies the following constraints 

1. horizontal 

2. Next maneuver occurs after -transfer time nr, where 
' n is specified and x is the post NH orbital period. 

3. Attitude between passive orbit and active vehicle is 
specified, 

Gener^y, the third constraint is assumed to occur at the maneuver 
following the NH maneuver. However, a self contained maneuver 
■and coast phase can be inserted into this-caiculation such that the 
third constraint applies at the second maneuver point following the 
NH maneuver; 


The calculation of the NH maneuver involves a Newton- 
Eaphson iteration scheme to determine the magnitude of the maneuver, 
using, an error in altitude as the dependent variable. A functional 
flow chart of the NH maneuver is contained in Fig, 2. 2, 4. 

2. 2. 2 NH Program Input-Outpu t 

The required inputs to the Height Maneuver Program are 

Za' £p Zp Active and passive state vectors at 
time of NH maneuver 

n Number of revolutions before mext 

maneuver 
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9.8.1 Rendezvous TaJgsting (continued) 


Height Maneuver Program 



Fig. 2. 2. 4 NH Functional Flow Chart 
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9»8.1 Rendezvous (continued) 


Ah Delta Altitude 

^ Initial guess of NH maneuver magnitude 

The outputs to this program are 

• maneuver Av 

t Time of the next maneuver 

—AS' Xas Active state at the next maneuver point 

2. 2. 3 NH Program Description 

A^detailed flow chart of the program is shown in Fig. 2. 2. 5. 

The program starts with the addition of the guess of the NH 
maneuver to the active vehicle velocity vector. The active state is 
then updated through n revolutions using the REVUP subroutine. 
Following the updating of the passive state to be radially above the 

active position vector using the RADUP subroutine, the height error 
is computed to be 


e - rpg - r^g -Ah 

representing the error in attaining the desired altitude difference. 

This error is driven smaller than c using the Newton Raphson iteration 
scheme contained in the ITER subroutine by varying the magnitude of 
the NH maneuver. 

2* 3 Coelliptic Maneuver Program <NC) 

2- 3.1. NC Program Objectives 

The objective of the coelliptic maneuver NC program is to 
compute a maneuver which will result in the passive and active 
orbits being coelliptic following the maneuver. Coelliptic orbits 
have an approximately constant radial separation distance. 

Fig. 2. 3. 4 is a functional flow chart of the NC program. 

The post maneuver velocity, which determines 'the active orbit, is 

a function of the passive state radially above the active vehicle at 
the NC time. 
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9 ♦ 8 . 1 Rendezvous continued) 


Height Maneuver Program 



Fig. 2, 2. 5 NH Detailed Flow Chart 
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9 • 8^ 1 Rendazvous ( conttinued) 


Coelliptic Maneuver 


Inputs: .Active and Passive state vectors 





Update passive vehicle state to be radially above active 
vehicle state 

*■ 



1 Compute post maneuver coelliptic velocity vector 



Compute coelliptic maneuver 


EXIT . 


Fig. 2. 3. 4 NC Functional Flow Chart 
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9.8.1 Rendezvous Targeting (continued ) 

2, 3, 2 NC Program Input -Out put 

The required inputs to the Coelliptic Maneuver Program are 

r^. v^, £p Vp Active and passive state vectors at 

time of 'NC maneuver 

The outputs to this progrEim are 

AVq NC maneuver Av 

2. 3. 3 NC Program Description 

A detailed flow chart of the program is shown in Fig. 2. 3. 5 

The program starts with an update of the passive state to 
a point radially above the active position vector using the RADUP 
subroutine. After obtain the altitude difference between the two 
position vectors, the COE subroutine is used to obtain the post maneuver 
velocity vector of the active vehicle. This is then used to obtain the 
NC maneuver. 

2. 4 Lambert Maneuver Program (NL) 

2.4.1 NL Program Objectives 

The main objective of the Lambert Maneuver Program is 
to compute a maneuver that will result in a trajectory which will pass 
through a specified target position vector at a given time. The target 
vector can be established by either a precision or conic update of the 
passive vehicle. The Lambert maneuver can also be executed 
either in an oblate or two-body gravity field. A functional flow chart 
of this maneuver is shown in Fig, 2. 4. 4. 

2.4.2 NL Program Input - Output s 

The required inputs to the Lambert Maneuver Program are; 

£a> Za’ — P' — p Action and passive state vectors at time of NL 
. ^ maneuver 

Time associated with the target vector 
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9.8.1 Rendezvous ^^^geting( continued) 


Coelliptic Maneuver 



EXIT 


Fig. 2. 3. 5 NC Detailed Flow Chart 
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Rendezvous ^^^geting (continued)' 


Lambert Maneuver 



Exit 


Fig. 2. 4. 4 NL Functional (Flow Chart) 







9*8.1 Rendezvous 1^argetin.g-( continued) 


The outputs to this program are : 
^V- NL maneuver Av 

—Li ? - , _ 

2. 4. 3 NL Program Description 


A detailed flow chart of the program is shown ia Pig. 2,4.5. 

The program starts with an update of the passive state to 
the target time to establish the target vector. This vector is then 
used in a Lambert routine to obtain the post NL maneuver velocity, 
which determines the NL maneuver.' 

2. 5 Terminal Phase Initiation Program, (TPI) 

2.5.1 TPI Program Ob-jectives 

The objective of the Terminal Phase Initiation ( TPI) pro- 
gram is to compute the TPI maneuver and the associated target vector 
required to initiate the terminal phase of the rendezvous sequence. 

The functional flow is illustrated in Fig. 2. 5. 4. 

The position of the TPI maneuver is determined by specify- 
ing either the time of the maneuver or the elevation angle which 
specifies the relative geometry of the vehicles at the TPI point. If 
the elevation angle is specified an iterative procedure is initiated to 
find- the TPI time at which this desired angle is attained. 

The TPI maneuver can satisfy either of two objectives. It 
can place the active vehicle, on an, intercept trajectory with the pas- 
sive vehicle or it can cause the active vehicle to pass through a 
target vector which has a particular relative geometry with respect 
to the passive vehicle at the intercept time. 

If a coplanar intercept, is desired, i. e. the active and pas- 
sive vehicles orbital planes aligned after TPI and before the final 
intercept of the target vector, the computed TPI maneuver is modified 
by nulling the active vehicle's out -of -plane velocity relative to the 
passive vehicle's orbital plane. This causes the orbital planes to 
intersect ninety degrees from the active vehicle TPI position vector. 

At the time corresponding to this nodal crossing a mid-course cor- 
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9.8.1 Rendezvous Targeting (continued) 


Lambert Maneuver 



Pig. 2. 4. 5 NL Detailed Flow Chart 
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9*8.1 Rendezvous Targeting (continued) 


rection is performed which aligns the two orbital planes. The tra- 
jectories then remain coplanar throughout the rest of the terminal 
phase. 


The differences between this TPI program and that used' in 
Apollo are: target offsets are used automatically in computing the 
TPI maneuver to account for oblateness affects; all updates are done 
with precision extrapolations; modification of the TPI target vector 
using range and altitude offsets; and the addition of a coplanar inter- 
cept mode. 

2.5.2 TPI Program Input -Outputs 

The required inputs to the TPI program are; 


-AI 

^PI 

^TPI 

E 


0)t 


BNGE' 


DELH 


CPI 


Active vehicle state vector 
Passive vehicle state vector 
TPI ignition time 

Elevation angle of passive vehicle from the 
active vehicle at TPI‘ 

Central angle of travel of the passive vehicle, 
from its TPI position to its final position ( TPP ) 
yielding the TPI target vector. Also deter- 
mines the transfer time, t„. 

Distance along the passive vehicle orbit from 
its position at TPP which defines a new target 
vector. 

Altitude above or below the passive vehicle 
orbit, measured along the target vector at 
TPP , which defines a new target vector 

Flag which determines if the coplanar inter- 
cept mode is to be used from TPI to TPP 
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9.8.1 Rendezvous Targeting Ccorittrmed) 


The outputs from this program are; 

Av^^pj - TPI deltav in Inertial Reference Coordinates 

AVrppj- ( LV ) - TPI deltav in active vehicle local vertical 

coordinates 

AVrppi ( LOS ) - TPI deltav in active vehicle line-of-sight co- 

ordinates 

- Target vector used in the powered flight 

routine for the TPI maneuver 


2,5,3 TPI Program Description 

The TPI program is entered during the rendezvous targeting 
sequence when the terminal phase of the rendezvous is to be initiated. 

The on-board estimated states of the active and passive 
vehicles are precision updated to the input TPI time. If the elevation 
angle has been input as zero, the TPI maneuver is executed at this 
time. 


If, however, the elevation angle, E, at TPI is specified, an 
iterative procedure is initiated to find the. TPI time at which this E 
occurs. This procedure uses the input TPI time as the initial guess. 
The input TPI time is changed by a time correction 6t which is based 
on: ( 1 ) the angular distance between the passive vehicle position and 
the desired position of the passive vehicle obtained by assuming the 
target vehicle is in a circular orbit and { 2 ) assuming the vehicles 
are moving at a constant angular rate. The following equation for 6t 
is used: 


6t 


Q! - r + SGN ^ ^ ^ *'a O 

“A -“P 


where 
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Of = E + SGN j^{£^- Xrp) • u J cos"^ (r^ . Tp/ Tp) 

.*• i . 

and w^, Wp.are the angular velocities of the active and passive vehicles 
respectively. 

The iteration is successful when-the computed elevation 
angle is sufficiently close to the desired elevation angle E. 

To help insure convergence, the following steps are taken: 

a. The step size 6t is restricted to 250 secs. 

b. If the solution has been passed ( 6E 6 Eq < 0 ), the step 
size is halved and forced in the opposite direction.of 
the last step. 

c. If the iteration is converging ( [ - jflE | < 0 ), the 

sign of 5t is maintained. 

d. If the iteration is proceeding in the wrong direction, 
the step direction is reversed. 

The iteration is teiTninated for any of the following reasons:- 

1. The-iteration counter has exceeded its maximum 
value of 15. 

2. The line -of -sight emanating from the active vehicle 
does not intersect the circular orbit with radius equal 
to that of the target vehicle. 

3. The elevation angle is inconsistent with the relative 
altitudes of the two vehicles ( e. g. , if the elevation 
angle is less than 180° when the active vehicle is 
above the target vehicle). 

Upon convergence, the state vectors are precision updated 
to the TPI time. 

The transfer time tp is then computed using cot in the Conic 
Extrapolation Routine ( Tme-Theta option) and the passive vehicle 
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state vector is precision updated through 'this time yielding the target 
vector for the TPI maneuver. If an offset range, RNGE (see- following 
diagram) is input, the passive vehicle -state at t„^„ = t^„, 

+ tp) is precision updated through an additional At to yield an offset 
target vector. The time increment At is given by' the equation” 

(rp:p 

which assumes the passive vehicle is moving at a constant angular 
rate. 

This modified target vector leads or trails the passive vehicle 
position at the intercept time and is in the same orbit as the passive 
vehicle. 



If an altitude differential between the passive vehicle orbit and the 
target vector altitude is input, DELH, the target vector magnitude is 
increased or decreased accordingly. 
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The precision target vector thus determined, whether it be 
the passive vehicle position at t^p^. or a target offset from the pas- 
sive vehicle position at is used in the Precision* Lanibert 

Routine to obtain the'TPI maneuver. This routine uses the offset 
aimpoint technique to compensate for the earth's oblateness effects. 

The coplanar intercept flag indicates if the TPI maneuver jusi 

computed ^d its associated-aimpoinfvector are to be modified or not. 

If the flag is set, the maneuver is modified in the following way: the 

computed. TPI deltav is expressed in a frame {I.V_ ) where the Z 

P — 

axis is in the negative direction of the active vehicle, position vector, 

the Y axis is normal to the passive vehicle plane and X forms a right 

handed system. The 3 components of deltav are AV . AV AV 

X y’ 2 * 

The active vehicle out-of -plane velocity relative to the passive vehicle 
- • • 

orbital plane, y, is then computed. The negative of this velocity over- 
writes Av , and the modified TPI velocity vector in the ( LV„) frame 
becomes ~y> This velocity is then expressed in the 

inertial reference frame and in the active vehicle local vertical frame. 

A new target vector is then computed by precision integrating 
the active vehicle state at TPI with the modified deltav added in to 
the time The time of the nodal crossing at which a midcourse 

maneuver is to be performed to make the orbits coplanar is then cal- 
culated using the- Time-Theta option of the Conic .Extrapolation Routine 
with (ot = 90*^.. 


The TPI maneuver AVjj.pj,the precision target vector ^p,p 
and the time of flight are used in the powered -flight routine which 
controls the vehicle and determines thrusting attitude during the 


maneuver. 
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TPI Program 



Figure 2.5. 4 TPI Functional Flow Chart 


9.8-30 

















Figure 2. 5. 5 TPI Detailed Flow Chart 
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Figure 2.5.5 TPI Detailed Flow Chart 
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Figure 2,5.5 TPI Detailed Flow Chart 
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Figure 2.5.5 TPI Detailed Flow Chart 
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Figure 2. 5, 5 TPI Detailed Flow Chart 
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Figure 2. 5 


1 

f 

EXIT 




TFI 


,5 TPI Detailed Blow Chart 
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2. 6 Rendezvpus Midcourse Maneuver Program (TPM) 

2.6.1 TPM Program Objectives 

The Rendezvous Midcourse Maneuver Program computes a 
midcourse correction (TPM) which insures that the active vehicle 
will intercept the desired target veptor at the desired intercept time 
established in the TPI .program. The functional flow is illustrated in 
Fig. 2.6.4 

The time of the midcourse correction is chosen so that an 
adequate time interval from the proceeding rendezvous maneuver 
( either TPI or a midcourse correction) occurs during which rendezT 
vous navigation can be performed. 

If the copianar intercept mode was used at TPI then the pro- 
gram is entered for the first midcourse correction at the time cor- 
responding to the nodal crossing of the active and passive vehicle orbital 
planes. This time is computed in the TPI program. 

-The TPM program recomputes the target vector to achieve 
the same objective as the TPI program attempted to satisfy., This 
ob 3 ective is to either intercept the passive vehicle or achieve a de- 
sired target position relative to the passive vehicle at the intercept 
time. 


2.6.2 TPM Program Input-Output 

The required inputs to the Terminal Phase Midcourse pro- 
gram are described below: 


~A " active vehicle state vector 

£?-■ Zp " passive vehicle state vector 
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time of TPI 

time of the .midcourse correction 

transfer time between TPI and TPP 

distance along the passive vehicle orbit irom 
its position at the intercept time which defines 
a new target vector 

DEL.H - altitude above or below the passive vehicle orbit, 

measured along the target vector at the inter- 
cept time which defines a new target vector 

The outputs from this program are; 

AV - TPM deltav in inertial reference frame 

AV^PPM^I-OS) - TPKEdeltav in the liue-of-sight coordinate 

frame 

Tpp. target vector fqr the midcourse maneuver 


*TPI 

^TPM 

V- 

RNGE 


2.6,3 TPM Program Description 

The Terminal Phase Midcourse program is entered after 
the TPI maneuver or a proceeding midcourse correction. The time 
of the midcourse correction's chosen so that an adequate time period 
from the previous maneuver occurs allowing rendezvous navigation 
to be performed. 

If the midcourse is the first one after a TPI maneuver in which 
the coplanar intercept mode was used, then the time of the midcourse 
is that which was determined in the TPI program. 

The on-board estimated states of the active and passive 
vehicles are precision extrapolated to the midcourse correction time, 
^TPM' passive vehicle state is then precision updated to the final 
intercept time, t-jpp) yielding the target vector for the midcourse 
maneuver. 
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li an offset range, RNGE, is input, the passive vehicle state 
at the intercept time is updated through an additional At to yield an 
olfset target vector. The time increment At is given by the equation 


At = - 

“ PT ^ ' 

which assumes the passive vehicle is moving at a constant angular 
rate. 


This modified target vector leads or trails the passive 
vehicle position at and is in the same orbit as the passive 

vehicle. 


If an.altitude differential between the passive vehicle orbit 
and the target vector magnitude is input, DELH, the target vector 
magnitude is increased or decreased accordingly. 

The precision target vector thus determined is used in the 
Precision Lambert Routine to obtain, the midcourse correction man- 
euver. This routine uses the offset aimpoint technique to compensate 
for the earth’s oblateness effects. 
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Terminal Phase Midcourse Program 



Figure 2. 6. 4 TPM Functional Flow Chart 
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Terminal Phase Midcourse Pi'ogram 



V 


Figure 2,6,5 TPM' Detailed Flow Chart 
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Figure 2,6.5 TPM Detailed Plow Chart 
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2. 7 Plane Change Program (PC) 

2. 7, 1 PC Program Objectives 

The objective of the Plane Change Maneuver is to compute a 
manetiver which will place the active vehicle into the plane of the 
passive vehicle. This is accomplished by nulling the out-of- plane 
velocity at a nodal point established by the previous maneuver. 

Fig. 2. 7. 4 is functional flow chart of the PC program, 

2.7.2 PC Program Input-Outputs 

The required inputs to the Plane Change Program are 
£p Vp Active and passive state vectors 

t Time o&the plane change maneuver 

The outputs to this program are ; 

Av PC maneuver Av 

-PC 

2. 7. 3 PC Program De scription 

A detailed flow chart of this program is shown in Fig. 2. 7. 5. 

The program starts with a precision extrapolation of the 
state vectors to the time of the PC maneuver. The out-of-plane 
velocity of the active vehicle is then calculated and inserted into' the 
PC maneuver. 
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Plane Change" 


Inputs.- Active and passive state vectors, 

the PC maneuver 

time of 


1 1 J 




Update active and passive states to the 



time of the PC maneuver 



> . 

Compute PC maneuver to null out-of-plane I 
velocity of the acti ve vehicle. ! 

^ T ^ * f 


EXIT 


Fig. 2. 7. 4 PC Functional Flow Chart 
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Plane Change 



EXIT 


■Fig., 2. 7. 5- PC Detailed Flow Chart 
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2. 8 Phase Match Program (PM) 

2, 8. 1 PM Program Objectives 

The objective of the Phase Match Program is to compute 
a set of state vectors that are "phase matched". These vectors, in 
the coplanar case, will be colinear. Hence, when entering a rendezvous 
targeting program with phase matched vectors, the program will 
approximately update the two state vectors over the same sector of ' 
the earth’s surface. 

In general, at the start of a typical targeting program, the 
passive vehicle will lead the active vehicle. In this case the passive 
vehicle has to be backed up using precision extrapolation to establish 
the phase matched vectors. The functional and detailed flow charts 
are shown for this case in Fig, 2. 8. 4 and 2. 8. 5. 

2- 8. 2 PM Program Input-Outpu t 

The required inputs to the Phase Match Program are 

£a* -A’ Ip’ Ip Active and passive state vectors at time' 
of first maneuvers to be employed in 
the targeting program . 

The outputs to this program are 
£p» Zp Passive state vector at phase match 

t Time associated with the new passive 

state vector 

2. 8f 3 PM Program Descriptio n 

A detailed flow chart of this program is shown in Fig. 2, 8. 5, 

The program starts by computing the desired unit vector of 
the passive vehicle at phase match. 

"-D = UNIt{ (r^ X v^) X X X Vp)} 


3 ^ 
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This vector is colinear with the intersection of the passive vehicle 
plane and the plane perpendicular to the active plane which contains 
the active vehicle's position vector. The central angle 9 is then 
computed between the passive vehicle's position vector and u as a 
positive angle when the passive vehicle leads the active vehicle. 
After checking to see if this angle is sufficiently small to terminate 
the iteration, the central angle is converted into a corresponding 
time At using a conic extrapolation routine. The passive state is 
then precision extrapolated through At to obtain a new estimate of 
the desired phase matched vector. 


Phase Match 


Inputs: Active and passive state vectors J 


1 


Compute desired unit vector of passive vehicle at phase 
match point j 


Compute central angle between passive state and 
desired phase match point. 




No 

1 Convert central angle into a corresponding delta time 





1 Extrapolate the passive state through the delta time 



Fig. 2. 8. 4 PM Functional Flow Chart 
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Phase Match 



Fig. 2. 8, 5 PM Detailed Flow Char,t 








9.8.1 Rendezvous Targeting' (continued) ; 

3. THE ASSEMBLY OF IHE INDEPENDENT MANEUVERS 

INTO PEETERMINAL RENDEZVOUS PROGRAMS 

f - ' 

As an application of the assembly of the basic preterminal 
maneuvers into an integrated rendezvous program, a Four Man- 
euver Sequence (FMS) will be considered. This FMS will closely 
parallel the four maneuver Skylab NCI. program.' The EMS consists 
of a phase maneuver enclosing two height maneuvers; the- latter 
enclosing a coelliptic maneuver. Also included is a phase match 
operation prior to the phase maneuver. 

- Following th.e FMS targeting and the addition of the>phas.e 
maneuver to the active vehicle state, the Triple Maneuver Sequence 
TMS will define the targeting for the three remaining maneuvers. 
This sequence parallels the NC2 program in Skylab. It consists 
of a phase maneuver vdiich encloses a height maneuver; the latter 
enclosing a coelliptic maneuver. The TMS also is initiated with a 
phase match operation. 

Following the TMS targeting and the addition 'of. the, new phase 
rnaneuver to the .active vehicle state, thp Double-Maneuver Se^quence 
DMS will define the targeting for the two remaining maneuvers. 

This sequence parallels the NCC program in Skylab. It consists- of 
a Lambert maneuver using an aim point.established by inserting a 
coelliptic orbit at the TPI point using the TPI geometry constraints. 

- Following the DMS targeting and the addition of the new 
Lambert maneuver to the active. vehicle state, the Single Maneuver 
Sequence, SMS will define the targeting for the final preterminal 
maneuver. This maneuver is a coelliptic maneuver resulting in 
oroits tnat are sepa rated, by an approximately constant radial dis- 
tance. 

The maneuver designations for each rendezvous sequence 

are: 
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Sequence Maneuvers 

FMS NP; NHl, NH2, NC 

TMS NP, NH, -NC 

DMS NL. -NC 

SMS NC 

The FMS and TMS programs are combined into one flow chart. Fig. c 
is an illustration of the FMS rendezvous. 

This section is divided into five parts. The first section 
lists the constraints which each maneuver sequence satisfies. The 
following sections are devoted to the individual maneuver programs. 


1' Constraints Associated with the Preterminal Rendezvous 


Programs 


' Sufficient constraints must be imposed on each maneuver 

sequence to uniquely define the trajectory (see Sec. 1.2).' In gen- 
eral, the constraints for the N-1 maneuver sequence can be obtained 
by deleting three constraints from the N maneuver sequence. The 
targeting constraints associated with the FMS mentioned above are" 


1. A Vj^p horizontal 

2 . AVj^Pj .horizontal 

3. AVj^P 2 horizontal' 

4. NHl maneuver occurs after a transfer time of 
n^ T, where is a specified number of revolu- 
tions and - is the period of the .post NP maneuvei 
orbit. 


5. NH2 maneuver occurs after a transfer time of 
^2 where is a specified number of revolu- 
tions and 7 is the period of the post NHl man- 
•euver orbit. 


6. NC occurs a specified time At from the NH2 
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Orbit of Passive VehicZe 



~ Period of post NP maneuver orbit 
-^2 ~ post NHl maneuver orbit 


Figure 3 Illustration of the FMS Rendezvous 







9.8.1 

.maneuver. 

7. Altitude between passive orbit and active vehicle 
at the NH2 time, Ah. 

8. Radial velocity at NC computed by coelliptizing 
the orbit. 

9. Horizontal velocity at NC computed by coelliptiz- 
ing the orbit. 

10. TPItime, tj. 

11. T PI elevation angle, ej_ . 

12. Altitude between passive orbit and active vehicle 
at TPI time, Ah^ . 

The targeting constraints for the TMS are obtained by re- 
moving the constraints 1, 4 and 7 from the FMS. For DMS, the 
additional- constraints 2, 3 and 5 are removed. The constraints on 
the coe'lliptic orbit are applied at the TPI point during the DMS 
program. For SMS, the coelliptic maneuver requires constraints 
8 and 9. Summarizing, tne constraints wnich apply to the rendez- 
vous sequences are shown oelow: 

Sequence Applicable Constraints 

TMS 2 , 3, 5, 6, 8, 9, 10, 11, 12 

DMS 6. 8, 9, 10, 11, 12 

SMS 8, 9 

As the coelliptic maneuver is independent of the TPI eleva- 
tion angle and altitude constraints, these constraints will not be 
satisfied by the active vehicle at the TPI time. 



• 9.8-52 



9*8.1 Rendezvous Targeting (Con't) 


3. 2 Four Maneuver Sequence (FMS) 

3'. 2 . 1 ; FMS' Program Objectives 

The objective of the FMS program is to compute a rendezvous 
trajectory which satisfies the constraints listed in Sec' 3. 1. The 
program computes the NP maneuver as well as the magnitudes of 
NHl, NH2 and NC maneuvers. 

This program contains two independent iteration loops em- 
bedded in ah outer iteration loop. Each loop is iterated with a 
Newton Raphson iterative scheme. The two inner loops determine 
the two height maneuvers' (NHl and NH2) and the outer loop deter- 
mines the phase maneuver (NP). 

A functional flow chart of the FMS program is shown in Fig. 

3, 2. 4. If the time of. the nodal crossing is desired following the NP 
maneuver, the active vehicle is. extrapolated through 90 degrees of 
central angle travel following the NP maneuver to establish this 
time . ■ 


3. -2. 2 FMS Program Input - Output 

The inputs for the Four Maneuver Sequence Program are: 



State vectors of active .and passive vehicle 


Time of the NP maneuver 

At 

Time between the NH2 and NC maneuvers 

*F 

Time of the TPI maneuver 

Ahp 

Altitude between the passive orbit and the active 
vehicle at the TPI time 
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Elevation angle 

S=1 FMS - TMS mode switch 


, Number of revolutions between the NP and NHl 

maneuvers 

Number of revolutions between the NHl and NH2 
maneuvers 


Ah Altitude between the passive orbit and the active 

vehicle at the NH2 time 

spc Plane change maneuver switch, ( = 1 for computa- 

tion of tp^ ) 

dvp, dVjj^ , dVjj 2 Nominal magnitudes of phase and height. maneuvers 


The outputs 

to the PMS Program are: 


NP maneuver /\v 


{ LV ) NP maneuver Av in local vertical co- 
ordinates' 

^H1 

Time of the NHl maneuver 

Vc 

Time of the plane change maneuver (if 
required) 

^"hi 

Magnitude of the NHl maneuver 

Av 

H2 

Magnitude of the NH2 maneuver 

Avc 

Magnitude of the NC maneuver 
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3./2. 3' - FMS Program Description ' 

The FMS program logic is illustrated in the detailed flow- 
chart in Pig. 3.2, 5. .This program involves two independent iter- 
ative loops embedded in -an outer iterative loop in order to compute 
a trajectory which 'satisfies the FMS constraints. The 'two inner 
loops "Use the magnitudes of the NHl and NH2 maneuvers as indepen- 
dent variables, whil'e'the outer loop utilizes the magnitude of the 
NP maneuver. Nominal values for these maneuvers are used in 
•the program as initial guesses in the iterative loops. 

Prior to entering the iterative loops, the passive state 
vector is "phase matched" to the active state vector at the time of 
the NP maneuver. • This results in the active and passive vehicles 
-traversing approximately tiie same central angle during the NP ‘ 
to TPI phase of the rendezvous. As the relative motion of two 
vehicles that traverse the same central angle in approximately 
the same orbits can be predicted based on either precision or 
conic updates, the NP program exclusively employs conic up.dates 

• » 5 • 

without losing significant accuracy compared with a program using 

' ■' t 

precision updates. 

The phase match procedure starts by updating the active and 
passive vehicles- to the NP time with precision and conic updates^ 
respecti-vely. A unit vector urp^ is then calculated which is co- 
linear with the intersection of the passive vehicle plane and the 
plane perpendicular to the active plane which contains the active 
vehicle's position vector. 

urpj^ ■ UKIT{[(r^p X X r^p] X frpp X Vpp)} 

The angle 6 between the two vehicles, is next calculated and 
defined as a positive angle for the passive vehicle leading- the -active 
vehicle. After converting 0 into a- corresponding time, the .passive 
vehicle is precision updated to the -estimated phase match time t^^. 
The updated position is then checked to see if it is approximately 
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colinear with calculation is repeated starting with 

the calculation of 0, 

For np’s in excess of 18 there is a possibility that the 
passive vehicle might lead the active vehicle by a central angle 
which exceeds 360 degrees. To allow for this possibility, the 
equation for 0 includes a term which will increase 0 by 360 degrees 
when Up exceeds 18 and the passive vehicle leads the active vehicle 
by less than 18,0 degrees. The final formula for 9 is- 

e = pi-clpi-cos'^ (urp^ • £pp7rpp)] + (d-i-l)(c-f-l)pi/2 
where d = SIGN(n„-18) 

ir 

c = SIGN[(urppX r^p) • UNITir^p X Vp^,)] 
and pi = 7T on the first pass through 0 and otherwise equals zero. 

Upon successfully completing phase match, the active vehicle's 
state vector is rotated into the plane of passive vehicle's orbit. The 
passive vehicle is then updated to TPI time and the desired active 
vehicle's position vector at TPI is established using the 

QRDTPI subroutine (sec. 3.6.9). This subroutine uses the eleva-- 
tion angle and the altitude between the passive orbit and the active 
vehicle at the TPI time in an iterative search which solves for the 
TPI geometry. 

The outer loop is initiated by adding the. NP maneuver to the 
active vehicle's NP velocity vector. Using the REVUP subroutine 
(Sec. 3. 6. 1), the new state- vector is updated through Hp revolutions 
to the NHl point. 

Prior to entering the first height iterative loop, the iteration 
counter switch c^ is set equal to 0 or . 5 if it is the first or subsequent 
pass .through the outer loop, respectively. This height loop starts 
by adding the estimated NHl maneuver to the active vehicle's 
velocity vector. The state is then advanced' to the NH2 maneuver ■ 
time using in the REVUP routine. To verify that the height 
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constraint Ah is satisfied, the passive vehicle must first be updated 

to be radially above the active vehicle. This -is accomplished using 

RADUP subroutine (Sec. 3.6,3) which computes the-central angle 

between the two vehicles and updates the passive vehicle state 

through that angle. -An altitude error e is then defined and 

HI 

checked to see if it is sufficiently small. This test is bypassed if 

the partial employed .in the iterative loop is zero in order that 

a value for p^^ may be computed for use in subsequent passes- 

through the NHl maneuver computation. If e., , , passes the test 

‘ HI ’ 

the program proceeds to the second height maneuver, - Otherwise, 
the ITER subroutine (Sec. 3. 6. 7) is used to obtain a new estimate 
of the NHl maneuver and the first height maneuver calculation is 
repeated. ITER is a subroutine encompassing a Newton Raphson 
iterative scheme based on numerical partials. 

Following convergence of the first height maneuver, the 
calculation of the second height maneuver NHl starts by setting the 
iteration counter c to 0 or . 5 depending on the value of c . The 
estimated value of the NH2 maneuver is then added to the active 
vehicle's state-at NH2, After updating the state through the time 
At to obtain the active vehicle's state at the NC point, the passive 
state is updated to be radially above the active vehicle's position 
vector using the RADUP subroutine. The coelliptic velocity for 
the active vehicle is then computed using the COE subroutine 
(Sec. 3. 6; 6) and the active's state vector is updated to the TPI time 
*p- passive -state is again updated to be radially above the 

active vehicle's position vector using the RADUP subroutine. . 


■ Based on the desired altitude difference Ah_, an altitude 
* F 

error '■s defined. If the partial p^^g employed in the iterative 
loop is zero and this error is sufficiently small, the program- pro- 
ceeds to the outer loop. Otherwise, the ITER subroutine is called 
to obtain a new value of the -NHl maneuver and updated values of 
Cj and the partial Pjjg* second height maneuver calculation is 

then repeated until the TPI altitude constraint is satisfied. 
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In addition to a constraint on the altitude at the TPI point, 

there is a constraint on the phasing. The updated active vehicle's 

position vector „ should be approximately colinear with r 
. , . -AFD* 

An angular error is defined which represents the central angle 

between and If this error is sufficiently small the 

program is terminated after calculating the required displays. 

Otherwise, the ITER subroutine is called to obtain a new value of 

the NP maneuver and to update values of the outer loop iteration 

counter c^, the partial and the stored Values of the error eo^ 

and maneuver magnitude dvo^. 
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FMS,' TMS Programs 


Inputs: See Sec. 3.2,2 


Phase match state vectors at NP Point 


Compute desired phasing constraint at the TPI point ; 


[Insert NP phase maneuver and update to NHl point 


I Compute NHl maneuver as height maneuver using height constraint 
! at next maneuver point and update to 1NH2 point (Bypassed if TMS prog. ) 


Compute NH2 maneuver as height maneuver, using coelliptic 
maneuver and TPI height constraint, and update to TPI point 


Complete phase maneuver calculation and recycle if 
necessary 


Search for plane change time 


Compute plane change time 
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FMS, TMS Programs 



Figure 3, 2. 5 FMS, TMS Detailed Flow Chart 
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Figure 3. 2. 5 FMS, TMS Detailed Flow Chart 
(page 2 of 6) 
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Using Ppp, Zpp' ®L' ~ ^ QRDTPI Subroutine (Sec. 3, 6. 9) 


^H2 " *Hr ^AH2 = ^AHV ^AH2 = ^AHl 



-A HIP " -AHl * ^-AHl^ 


Update through revolutions using REVUP 

Subroutine (Sec. 3.6.1), obtaining r v 

' AH2 “AH2, 

^H2'^ ~ ^H1 ' 
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Figure 3.2.5 FMS, TMS Detailed jb'low Chart 
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Figure 3.2. 5 FMS, TMS Detailed Flow Chart 
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Update Cj, ^2 “ 

ITER Subroutine ( Sec. 3.6.7) 


ep ^ SIGN[(r^p ^^'IaFD^ ’ <£aFD ‘ W^AFD 


.page 3^ 


nepKe^X. Yes 


Update Cp, p^, ®°p* using Cp 

in ITER Subroutine (Sec. 3. 6. 7 ) 


UNIT ( X £^p ), Avp ( LV ) = ( dvp, 0. 0 ) 


Avjj - dvjjg, *H = 


" -ASF ■ ^S 


Update £^p, v^pp through 90° using Conic 
hlxtrapolatlon Routine, obtaining ^p^ 


EXIT 


Figure 3. 2. 5 PMS, TMS Detailed Flow Chart 
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3.3 Triple Maneuver Sequence Program (TMS) 

3.3.1 TMS Program Objectives 

The objective of the Three Maneuver Sequence program is 
to compute a rendezvous trajectory which satisfies the constraints 
listed in Sec. 3. 1. The program computes a phasing maneuver 
and the magnitudes of a height and a coelliptic maneuver. 

This program contains an outer iterative loop to determine 
the phase maneuver and an inner loop to calculate the height man- 
euver. The program's logic is very similar to the FMS program, 
and is herein treated as a subset of the FMS program logic, as 
represented in the functional flow chart in Fig. 3.2. 4. 

3.3.2 TMS Program Input- Output 

The inputs for the Three Maneuver Sequence are: 

r . , v . j r^, v_ Active and passive state vectors 
—A —A -P — P 



Time of the NP maneuver 

At 

Time between the NH and NC 
maneuvers 


Time of the TPI maneuver 

<1 

Altitude between the passive orbit 
and the active vehicle at the TPI 
time 

"l 

Elevation angle 

S = 2 

FMS - TMS mode switch 


Number of revolutions between the 
NP and NH maneuvers 

k 

spc 

Plane change maneuver switch 
(= 1 for computation of 
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AVp, AVp Nominal magnitudes of the phase 

and height maneuvers 

The' outputs to the TMS program are: 

AVp NP maneuver Av 

AVp(LV) NP maneuver Av in local vertical 

coordinates 

Time of the NH maneuver 

Time of the plane change maneuver 
(if required) 

Magnitude of the NH maneuver 
Magnitude of the NC maneuver 

3.3.3 TMS Program Description 

The detailed flow chart for Triple Maneuver Sequence prog- 
ram is incorporated in FMS flow chart in Fig. 3.2, 4. As the TMS 
logic is' just a subset of the logic of the FMS (i. e. , it eliminates one 
of the height maneuvers in the FMS program), the reader is referred 
to Sec, 3.2. 3 for the- TMS program description. 


'H 


PC 


Av. 


H 


Av. 
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3. 4 • Double' Maneuver Sequence Program (DMS) 

3,4.1 DMS Program Objectives 

The objective of the Double Maneuver Sequence program is 
the computation of a Lamberfmaneuver based on a target vector 
obtained by determining a coelliptic orbit at the TPI point. 

Fig. 3,4.4 is a functional flow chart of the DMS program. 

3. 4. 2 DMS Program Input-Outputs 

The required inputs to the double maneuver sequence 
program are: 

— A'— A'— P'— P Active and passive state vectors 

t - -Time of the Lambert maneuver ' 

t_ Time of the TPI maneuver 

e Elevation angle 

Ah Altitude between the passive orbit 

and tha active vehicle at the TPI 
time 

At Time between the Lambert and 

coelliptic maneuvers 

The outputs to this program are: 



Lambert maneuver Av 


Coelliptic maneuver Av 


3.4.3 DMS Program Description 

Fig. 3. 4, 5 is a detailed flow chart of the Double Maneuver 
Sequence program. 

The program starts with precision updates of the active and 
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passive vehicle's state vectors to t and t , respectively. The 
QRDTPI' Subroutine is then called to obtain the passive vehicle's 
state £pp> Xpjp i^adially above the desired active vehicle's position 
vector at TPI. Using the passive vehicle's state vector and the 
altitude difference Ah, the COE subroutine is called tO'Obtain the a 
active vehicle's state r^^, v^^ prior to the TPI maneuver. This 
state vector is then integrated backwards using the Precision Extra- 
polation Routine to the time of the NC maneuver, obtaining the 
target vector for the Lambert maneuver. The Precision 
Lambert routine is next called to obtain the NL and NC velocities 
based on setting the number of precision offsets equal to two 
and the cone angle equal to 15 degrees. The rotation projection 
switch fg is. obtained from this routine for use in the powered flight 
steering program as After calculating the NL and.NC maneuv- 
ers, the-NL maneuver is rotated into a lhod vertical coordinate 
systern for display purposes. 
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DMS Program 



Fig. 3.4.4 DMS Functional Flow Chart 
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Obtain the Lambert maneuver using the target 
vector in the Precision Lambert Routine 

EXIT 


Fig, 3.4.4 DMS Functional Flow Chart 
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DMS Program 



Fig. 3.4.5 DMS Detailed Flow Chart 
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Fig. 3.,4. 5 DMS Detailed Plow Chart 
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3. 5 Single Maneuver Sequence Program (SMS) 

3. 5. 1 SMS Program Objectives 

The objective of the Single Maneuver Sequence, Program 
is the computation of the coelliptic maneuver (NO. Pig. 3. 5. 4 
is a functional flow chart of the SMS program. 

3. 5. 2 SMS Program Input-Outputs 

The required inputs to the single maneuver sequence pro- 
gram are; 

— A'— A’— P'— P Active and passive state vectors 

tj^ Time of the NC maneuver 

t_ Time of the TPI maneuver 

F 

Elevation angle 

The outputs to the program are; 

Coelliptic manevuer Av 

3, 5. 3 SMS Program Description 

Fig. 3. 5. 5 is a detailed flow chart of the Single Maneuver 
Sequence program. 

The program starts with precision updates of the active 
and passive vehicle's state vecotrs to time The out-of-plan 
parameters are next computed. Following rotating the active state 
into the plane of the passive orbit, the passive state is updated to be 
radially above the active vehicle's position vector at the NC point. ■ 
Using the COE subroutine, the coelliptic maneuver is computed such 
that the resulting post maneuver velocity vector of the active vehicle 
win be parallel to the plane of the passive vehicle's orbit. After 
updating to the TPI time, the TPI program is used to obtain the 
TPI time which corresponds to a specified elevation angle. 
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Single' Maneuver Sequence Program 



Fig, 3.5.4 SMS Functional Plow Chart 
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EXIT 


Fig. 3.5,4 SMS Functional Flow Chart 
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Single Maneuver Sequence Program 
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EXIT 


Fig. 3.5.5 SMS Detailed Flow Chart 
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3. 6 Miscellaneous Subroutines Used in the FMS 

This section contains a discussion. of the special subroutines 
that are used in the FMS rendezvous targeting programs contained -in 
Sections 3.2 t 3, 5. As these subroutines are short and easy to 
follow, the input-outputs are sometimes only listed on the detailed 
flow charts and the objectives of the subroutines are contained in the 
description of the subroutine. 

3.6.1 REVIIP Subroutine 

The REVUP Subroutine (Fig. 3, 6,2) conically updates a 
state vector r, v through a specified number of n of revolutions. The 
semi-major axis a is first calculated and then used to convert n 
revolutions into a corresponding time by multiplying n by the period 
of the orbit. After concially updating the state through this time, 
the program returns the new state and the time. 

3, 6. 3 RADUP Subroutine 

The RADUP Subroutine (Fig. 3. 6.4) conically updates the 
passive vehicle's state vector £p, Vp to be radially above the position 
of the active vehicle r^. The central angle 0 between the two vehicles 
is initially calculated as a positive angle if the active vehicle leads 
the passive vehicle. The passive vehicle state is then updated 
through e using the Time-Theta Subroutine to obtain the desired state.. 


3,6.5 COE Subroutine 

The COE Subroutine (Fig. 3. 6. 6 ) computes the active vehicle's 
coelliptic state based on the state vector r, v of the passive vehicle 
and a delta altitude h. After computing the semi-major axis a of the 
passive orbit, the desired semi-major axis a^ of the active vehicle's 
orbit is calculated. This is then used to compute the desired radial 
component of velocity v„ and the velocity vector v. for the coelliptic 
orbit. 
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3. 6. 7 ITER Subrou'tine 


The ITER Subroutine (Fig. 3, 6, 8 ) encompasses a Newton 
Raphson iteration scheme based on empirical partials. It utilizes 
as inputs: 

1. Current v and old values of the independent varia- 
ble. 

2. Current e and old values of the dependent variable. 

3. Estimate of the partial p = de/dt, 

4. A switch c which can assume three values: 

c = 0 - First pass, p equals zero so increment v by one. 

c = , 5 - First pass with non zero p, so compute 
change in v to be e/p. 

c . 5 - Change v based on new partial computed 
from e, e^, v and v^. 

In addition to computing a new estimate of the independent variable, 
this routine-updates the quantities e^, v^, p and the iteration counter 
c. It also displays an Alarm Code whenever the counter exceeds 15. 


3.6.9 QRDTPI Subroutine 

The QRDTPI Subroutine (Fig. 3. 6. 10) determines the de- 
sired active vehicle's position vector at the TPI time. The inputs 
to this subroutine are: 

r , V - TPI passive vehicle's state vector. 

h - Altitude between the passive vehicle's orbit and the 
active vehicle at the TPI time, 
e - Elevation angle. 

s - Switch: 0 for coasting integration, 1 for conic update. 
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The subroutine utilizes the ITER Subroutine (Sec. 3.6.7) 
in an iterative search for the desired r^. Each pass through the 
iterative loop involves an update of the passive vehicle's state vectoj 
to the estimated time associated with the passive vehicle's posi+ion 
radially above An error e^ is then calculated which represents 
the difference between the desired central angle between the active 
and passive position vectors at the TPI time and the actual central 
angle. This error is driven to be smaller than using the Newton 
Raphson iterative scheme contained in the ITER Subroutine. 


9.8-81 




Figure 3, 6. 2 REVUP Subroutine Flow Chart 



Figure 3. 6. 4 RADUP Subroutine Flow Chart 
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Figure 3. 6. 6 COE Subroutine Flow Chari 










Figure 3.6.8 ITER Subroutine Flow Chart 
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QRDTPI Subroutine 


Inputs; r, V, Ah, e, s 


c = 0, t 0 


Yes 


e = e - 7T 


= 0\ Yes 


Advance r^, v through t using 
Conic Extrapolation Routine obtaining r-, v, 

— V — 0 


Advance r, v through t using 
Precision Extrapolation Routine obtaining r^., Vj 


= ir / 2 - Q - sin"^ |^( Tj - Ah ) cos ( e ) / r J 
- cos"^ [^UNIT(r) . UNIT (Xj) jsiGN j^(rj Xr) . (rX v)J 




Return; Xj,, ^ 

Ja = £j - Ah UNIT (£j) 


Update c, p, t, using e^ in 

ITER Subroutine (Sec. 3.6.7) 
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4. SUPPLEMENTARY INFORMATION 

There are several steps that have to be completed prior to the 
selection of the preterminal rendezvous scheme. First, the mission 
and operational constraints that impinge on the rendezvous configura- 
tion have to be defined. These next have to be converted into a set 
of targeting constraints which relate to the rendezvous trajectory 
itself, (For example, if the TPI maneuver is to be aligned along the 
line of sight, it might be necessary to constrain the TPI elevation 
angle and edtitude as well as the distance between TPI and TPF. ) 

Upon completing this task, the minimum number of maneuvers involved 
in the preterminal targeting scheme will have been determined. This 
is because the rendezvous configuration must contain a sufficient 
number of maneuvers such that the corresponding degrees of freedom 
equals or exceeds the number of targeting constraints imposed. The 
number of degrees of freedom involved in an N maneuver rendezvous 
was originally defined in Ref, 1, and used to define the allowable 
number of Skylab targeting constraints in Ref. 2 and 3. 

Assuming that the number of required targeting constraints 
derived from the mission constraints is less than the number of degrees 
of freedom involved in the rendezvous, additional constraints must 
be conceived to uniquely define the rendezvous configuration. Con- 
siderable work has been directed toward the problem of selecting 
rendezvous trajectories that minimize the fuel consumed (Ref. 4). 

Some very simple procedures might be used to accomplish this goal. 

For instance, maybe the specification of fractional orbital periods 
between maneuvers could be eliminated and the corresponding maneu- 
ver times optimized to conserve fuel. It would also conserve some 
fuel if the maneuvers were applied along the velocity vector instead 
of in the horizontal direction. 

The TPI program (a carryover from Apollo and Skylab) con- 
tains an iterative search to determine the time that corresponds to 
a specified elevation angle. This iteration scheme fails in some 
cases where the height separation between the orbits becomes small 
( approximately four miles or less ), It appears that a redesign of 
the iteration scheme would eliminate this possibility. 
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Most of the targeting constraints and types of maneuvers con- 
sidered herein originated with NASA MSC. 

The authors recommend investigating an approach whereby all 
the basic maneuvers are programmed as separate entities and are 
available for assembly into different rendezvous schem.es as selected 
by the astronaut during the flight. Most of these maneuvers would 
contain the options of 1 ) phase match prior to the maneuver, 2 ) conic 
or precision extrapolations 3 ) generation of the plane change maneuver 
time and 4) astronaut overwrites. The storage requirements of such 
a general purpose rendezvous targeting program have to be determined. 
Hopefully, the increased requirements, which are not necessarily 
significant, will be offset by the advantage of the general program’s 
flexibility. 
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1. INTRODUCTION AND FUNCTIONAL FLOW DIAGRAM 


The purpose of the Relative State Updating function is to 
provide a means of automatically and autonomously improving on- 
board knowledge of the- relative state between the SSV (primary 
vehicle) and another orbiting vehicle (target vehicle). This know- 
ledge would be required in (a) rendezvous missions as inputs to 
rendezvous targeting programs to compute maneuvers which effect 
rendezvous between the primary and target vehicles or ( b ) orbit 
navigation modes which utilize tracking of navigation satellites or 
satellites ejected from the primary vehicle. 

Rendezvous navigation sensor data, consisting of measure- 
ments of some portion of the relative state, are accepted at discrete 
"measurement incorporation times". Relative state updating is ac- 
complished at each of these times by sequentially processing the 
components of the relative state measured by the sensor. A pre- 
cision extrapolation routine extrapolates the primary and target 
vehicle state vectors and the filter weighting matrix from one 
"measurement incorporation time" to the next. A typical measure- 
ment incorporation sequence is thus; 

( a) Extrapolate primary and target vehicle state vectors 
and filter weighting matrix to measurement incor- 
poration time ( ) 

(b) Accept set of rendezvous navigation sensor data 
taken at time = This will consist of k compon- 
ents of the relative state at given by Q . ( i = 1 , 

2, , k). A measurement code (c^) is associated 

with each to identify the type of measurement 
taken. 
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( c ) Process in the Measurement Incorporation 

Routine, If more than one component of the relative 
state is being sensed, process Qg, Q^, 
sequentially in the Measurement Incorporation 
Routine. 

(a) thru (c) are then repeated for the next measurement incorpora- 
tion time. 

A general flow diagram of this function is presented in Fig. 

1. The inputs required by this function are; 

1. On-board estimate of primary vehicle state (x_) 
with time tag, 

2. On-board estimate of target vehicle state {x,j,} with 
time tag. 

3. Initial filter weighting matrix (W) (not required if 
computed using Automatic Initialization Routine). 

4. A priori sensor measurement variances, 

5. Rendezvous sensor measurements. 

The output of this function is an updated n-dimensional state (x) 
which minimizes the mean squared uncertainty in the estimate of the 
relative state. This output is available after each measurement 
incorporation. 

The operations shown in Fig. 1, with the exception of pre- 
cision extrapolation, belong in this function. The Precision Extrapo- 
lation Routine is described in another report. The bulk of the 
equations involved in this function are associated with the Measurement' 
Incorporation Routine. The equations involved in an optional Auto- 
matic Initialization Routine (initializes the filter weighting matrix) 
will also be described. The equations associated with reading the 
rendezvous navigation sensor will be described in a later report. 
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Figure 1 RELATIVE STATE UPDATING FLOW blAGRAM 
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NOMENCLATURE 


b 


n" dimensional measurement geometry 


kpo" kp3 


b 


3 dimensional measurement geometry vectors as 
sociated with £p, Vp 

J-dimensional measurement geometry vector as- 
sociated with 7 p 


c. Measurement code identifying i th measurement at 

t 

m 

FIRSTMEAS Initially set to "l" and reset to "0" after first 

entrance into Measurement Incorporation Routine 


FULLTRACK "l" if angles and relative range measurements have 
been taken prior to final intercept maneuver. 

"O” if angles or relative range measurements only 
have been taken prior to final intercept maneuver. 


MANEUVER Initially set to "O". Set to "l" at completion of 
maneuver 

MANNOTEKl Assumed "no track" time immediately prior to 
maneuver 


MANNOTRK2 Assumed "no track" time immediately following, 
maneuver 


MANTM Predicted time of next maneuver ( either from pre- 

loaded input or previous .targeting routine) 

^NB-m Transformation matrix from navigation base axes to 

rendezvous sensor axes. is fixed according 

to spacecraft configuration. 


9.8-93 




^R-SM 

Tramsformation matrix from reference coordinate frame 
(in which initial state is expressed and computations are 
performed) to stable member axes . Mp is given from 

specified platform alignment 

^M-NB 

Transformation matrix from stable member axes 
to navigation base axes on which IMU is mounted. 
^SM-NB determined from IMU gimbal angles 

notracktm 

Maximum break in tracking threshold - if time of 
"no track" period exceeds this^ W reinitialization 
is inhibited until scfter 3 measurement incorporation 
times 

POSTMANWR 

Initially set to "O". If set to "l", forces W rein- 
itialization prior to first mark after maneuver. 

^EST 

On-board estimate of measured parameter 

Qj 

i th measured parameter at t 

m 

Tp 

Magnitude of vector Tp 

£p 

Primary vehicle position vector 

£t 

Target vehicle position vector 

£tp 

Relative position vector 

£u 

REND WF LAG 

Position vector found in Automatic Initialization Routine 
(A.I.R) 

"O" - W is left as extrapolated value from Precision 
Integration routine ( initially set to "0") 

"l" - W is set to pre-loaded value given by 

t 

m 

Measurement Incorporation Time 

TBEFCOMP 

Minimum time required prior to a final targeting 
computation to allow requested W reinitialization to 
be performed 
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TPIMAN 


UNIT (£p) 
UPD 


-TP 

VAR 

W 

WAIT3TM 



WMAXTM 


WRTM 


Initially set to "0". Set to "l" at completion of 
final intercept maneuver ( TPI) 

Unit vector (£p/ Tp) 

= 1 find state of primary vehiclt 
= 2 find state of target vehicle 

Primary vehicle velociiy vector 

Target vehicle velocity vector 

relative velocity vector 

A priori random measurement error variance 

Velocity vector found in A.I.R. 

n X n filter weighting matrix associated with x 

Initially set to "0" and reset to ”1" in order to 
inhibit W reinitialization until after 3 measurement- ' 
inforporation times 

Pre-loaded value of initial filter weighting matrix 

Pre-loaded value to which W is reinitialized 

Maximum threshold value - if time since last W 
reinitialization exceeds this, a W reinitialization is 
forced to occur prior to the first mark after the 
next maneuver 

Normal threshold value - if time since last W rein- 
itialization exceeds this, a W reinitialization is 
requested 
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X 

lip| 


>1 

■ ■ 1 


II 

It 


-V 

II 


At 


m 



5x 

Ip 


n -dimensional state vector 
6 dimensional primary vehicle state vector 

6 dimensional target vehicle state vector 

6 dimensional state vector found in A, I, R, 

Time increment between measurement incorpora- 
tion times 

n- dimensional navigation update of x 

A priori standard deviation of stable member mis- 
alignment 


£t 


A priori standard deviation of misalignment between 
sensor measurement frame and navigation base 


V ^6 


A priori standard deviation of sensor bias errors in 
range, gimbal angles ^ and 8 (Fig, 2) 


J-B 


3 dimensional sensor bias vector 




A priori standard deviation of sensor random errors 
in range, 8, 6 


M 


Gravitational constant 
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2. DESCRIPTION OF EQUATIONS 

The recursive navigation equations presented in the Measure- 
ment Incorporation section are general with respect to the dimension 
of the state vector to be updated. These equations are therefore 
applicable to any one of the following navigated state vectors which is 
selected for the shuttle relative state updating function. (This selec- 
tion will ultimately be based on shuttle G & N computer capacity, 
expected target vehicle state uncertainties, and the error character- 
istics of shuttle navigation sensors. ) 


Table I 


Possible Navigated States 


Navigated State (x) Parameters Updated State dimensions (n) 


A. X = Xp or Xp 


B. X 



orxrj. 





C. 



D. 



primary vehicle state 
or target vehicle state 


primary or target vehicle 
state plus j components 
of sensor bias 


primary and target 
vehicle states 


primary and target 
vehicle states plus 
] components of 
sensor bias 


6 


6+j 


12 


12+j 
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For any of these navigated state vectors, the relative state does not 
appear directly, but is updated implicitly as a result of the update of 
either or both vehicle inertial states. Utilizing the state vectors (A 
or B) results in the Apollo rendezvous navigation filter, whereas 
either state vector (C or D) results in an optimum .rendezvous navigation 
filter. Specifying the dimension (n) of the navigated state vector 
automatically specifies the dimension of the measurement geometry 
vector ^to be (n), and the filter weighting matrix W to be n x n. 


2. 1 Measurement Incorporation Soutine 


As discussed above, this routine is entered k ( number of 
measured components from sensor) times at each measurement in- 
corporation time (t^). The equations presented below are identical 
for incorporation of each of these components with the exception of 
equations for Q^jgrp and VAB which depend on the component in- 
corporated. Equations for b, Qgg.p, and VAR are given for typical 
relative measurement parameters and bias estimation, since the 
precise parameters will not be known until the rendezvous sensor ( s ) 
are selected. The assumed sensor coordinate frame geometry is 
shown in Fig. 2. (Gimbal limits are assumed to be between + 90°). 


The precedure for computing b, Qggrp and VAR is as follows: 


Compute the relative state ( Xp ) from: 


-R 


I 

\^TP 


” — P 


and 


9.8-98 





9.8.2 Relative State Updating (Con’t) 


UR^p = UNIT (R,j,p.) 

From the measurement code (c.), compute b, Qx-orr. 
and VAR appropriate to this measurement. 


For sensor gimbal angle (8, ^ ) measurements, make the 
following preliminary computations: 



Compute the unit vectors of the sensor coordinate 
frame ux^. uy , uz from: 


/ -.n 




^NB-m ^SM-NB ^R-SM 




@ Compute sin (0), (Fig. 1) from: 

S = - . uy 

—TP — ■'m 


and 


®xz 


Computation of b 


Depending on the ultimate selection of the navigated state 
(x of Table I), the vector b will take on the following definitions: 


g-s-ioo 



9*8.2 Relative State Updating (cont*d) 




Compute bpQ.and from the appropriate equations 
in the following table using to identify the type of 
measurement 


Measurement 




Relative Range 
■Range Rate 
Sensor Angle (p) 
Sensor Angle (0) 


UNIT(uR^pXuy^)/R^^ 

(uR.j.pXuyj^)x 


-uRtp 


0 

0 


Compute 

If^-B ^ included in the navigated state, b will be 
computed based on the. selection of' biaS’ parameters 
to be estimated. The following are equations for 
some possible b 's, with used to identify the 
measurement type 
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(a) 


Estimating a single bias Cy^ ) in measurement 
code = j)t Por. measurement (code = c/) - 


b 

7 


( scalar) 




(b) Estimating bias (xg) in m of the total of k 

measurements, the measurement codes of the 
m measurements being; 1, 2,. . . . , -m; 



b =0 for c. > m 

-V - 1'' 

(c) Estimating three angles (or , or , or ) -'Of the 

^ y z 

stable member misalignment about x, y, z 
axes of stable member, .i, e. 



Measurement 

Relative Range 
Range Rate 


b^ ( 3 dimension al) 

0 

O' 


Sensor Angle (« 

Sensor Angle (0) ( UNIT(uR^pX uy^ ) ) 


9.8-102 



9.8.2 Relative State Updating C(^oiit*d) 


Computation of Qgg/j> 


(4^ Compute estimate of bias ( 7 > in measurement form: 

A K A 

7 ^ Tb 

^Xb initially set to O^nnd attains a value after 
measurement incorporation for a state ( x ) which 
contains will be the corresponding compon- 

ents of 6x in Eq, ( 11 ) ) , 

Compute Q^st appropriate equation identi- 

fied by the measurement code ( c^); 

'Measurement 

Relative Range 
Range Rate 

Sensor Angle (,S) 

Sensor Angle (S) 


^EST 
^TP ”^"V 

~'TJP " ^?-XP T 


, uR„t 3 • ux 
Tan"^ ( + 7 

Sin~^ ( s ) + 7 


C omputation of VAR 

Equations for VAR can not be anticipated as easily as was 
done for b and Qgg-j' since it is so strongly a function of the error 
model for the particular rendezvous sensor selected for the final con- 
figuration. The measurement variance can be a constant or some 
fimction of relative range, range rate, etc and it may. have a minimum 
threshold. Consequently, equations for VAR will not be given at this 
time. 
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9.8.2 Relative State Updating (coated) 


State Vector and Filter Update at Measurement Incorporation Time 

The n X n filter weighting matrix { W ) is available from one 
of the following sources; 

At the first measurement incorporation: 

1. Pre-loaded values based on-mission simulations 

2. As an output of the Automatic Initialization Routine 

Between measurement incorporations at a given t^: 

3. From the computation (below) after a measurement 
incorporation 

At the first measurement incorporation of new t^: 

«i^ 

4. From the Precision Extrapolation Routine 

5. From the Automatic Reinitialization Routine 



Compute n-dimensional.£ vector for measurement 
( c^) from: 


T 

W b 



Compute n-dimensional weighting vector w, from: 


CO 


= Wz 

z • z + VAR 


This routine provides the state and bias portions of W when time in- 
variant biases are modeled. For estimation of biases modeled as time 
variant, appropriate equations in the Precision Extrapolation Routine 
will be formulated. 
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9 • 8 . 2 Relative State. Updating (cont*d) 



Compute n-dimensional navigation update of x for 
measured parameter {code = c^) from: 


“ *^EST^- 


Update X by: 

X = X + 5x 


@ Update W by 


W = W- wz-^/(l + 


YAR 


y z . z H- VAR 


-) 


2.2 Automatic Filter Weighting Matrix (-W) Reinitialization 

,If reinitialization of the filter weighting matrix is required 
( e.g. if navigated states A or B of Table I are utilized)-, this opera- 
tion may be accomplished automatically by the Automatic Reinitialization 
Routine. This routine consists almost entirely of logic statements 
so that there is no real need to present a description of equations here. 
Instead, the detailed description of the routine will be provided by the 
detailed flow diagrams, and a brief description of the approach will 
be given in this, section. 

A conservative approach is taken in that W is reinitialized 
to pre-stored values more often than actually required but not at a 
time which would violate accepted W matrix reinitialization ground 
rules. The only exception to this is the case in which not reinitializing 
will most probably .produce a greater performance degradation than a 
reinitialization. The ground rules which prohibit reinitialization are: 
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9.8,2 Relative State Updating Ccont'd) 


1. No reinitialization unless a minimum time (TBEFCOMP) 
exists prior to the final targeting computation for a 
rendezvous maneuver. 

2. No reinitialization following a "no tracking" interval 
greater than NO TRACKTM seconds, until after 3 
measurement incorporation times. 

The only exception occurs when a maximum time has passed without 
a reinitialization ( WMAXTM) because of ( 1) or (2 ). In this case a 
reinitialization is forced to occur immediately following a rendezvous 
maneuver { representing a "no track" interval) instead of waiting the 
required 3 measurement incorporation times as specified by (2). 


2.3' Automatic Initialization Routine 
2. 3. 1 Introduction 

This routine provides a means for computing an initial filter 
weighting matrix for recursive navigation which is closely related to 
the actual errors in the computed relative state. Two position fixes 
are required. The equations described relate to the problem of find- 
ing the inertial state of one vehicle given in the inertial position of 
the other and the relative position of the two. 


The routine might be used if the inertial state of the primary 
vehicle is poorly known. That is, the estimate of the relative state 
is so bad that the (linear) recursive navigation filter does not con- 
verge. This situation might arise, for instance, when (sensor) 
acquisition does not occur until the range between the vehicles is of 
the same order of magnitude as the relative error between them. 
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9.8.2 Relative State Updating (cont*d) 


2. 3. 2 Program Input -Output 


The required inputs to the routine are two sets of sensor 
measurements at t^ and and two inertial positions at tj^ and t 2 * 

Also required are various assumed values for instrument performance ■ 
to be used in forming the W matrix. 

^1 

„ 0 

1 




sensor measurements at t-, 


^2 

^'2 

e 


sensor 'measurements at t. 


^R-SM 

^ ^1 *2 ^ ^ rotation matrices 


M. 


NB-m 


-T1 

-T2 


} 


known inertial position of target at t^^ 
known inertial position of target at t 2 




a priori standard deviation of sensor random 
measurement errors 


^■r 

^]3 

^0 


a priori standard deviation of bias in sensor 
measurement 
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9»8.2 Rfilative State bpaatxiig v,cont'd) 


“T 


a priori standard deviation of misalignment 
— T between sensor measurement frame and navi- 
gation base 


“P 


a priori standard deviation of stable member 
— P misalignment 


'^P 


U 


The output of the program is Xp ( or ) at t^ and an n x n 
W matrix to use in relative state updating. 


2.3.3 Description of Equations 

The following equations are in two parts, computing the 
state of the unknown vehicle and computing the related covariance 
and W matrix. The first set of equations uses two position "fixes" to 
solve Lambert’s problem for the velocity connecting the positions. 

Calculation of the State 


Let Tp )3^, and r^, measurements made by 

the sensor at the times t, and t.,. Find the cartesian vector , 

^ * — TPb 1 

in the sensor frame, shown in Fig. 2. 

^TPS 1, 0 ^ ^1 ^1 

^TPS 1, 1 ^ " ^1 

1 2 ~ ^1 COS jBj 
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9*8.2 Relative State Updating (cont’d) 


Using the same relations define r^pg Transform the vector r,ppg 

from sensor frame to reference frame. 


T T T 

-TP 1 " ^M-NB 1 ®^NB-m -TPS 1 


Similarly define the vector R^p ^ from (r^, 0^). Depending on'the 

value of logic switch, UPD, extrapolate either the primary or target 

vehicle to the times of the two fixes t^^ and Using these two inertial 

positions-the two relative positions, and the time interval At = L -t, 

. ^ X 

find the velocity v^^j ^ % ■'^3. the Lambert Routine, The six -dimensional 

state vector g ^2 • ' 


-U 2 


-U 2 


-U 2 


From two position measurements it is impossible to estimate any 
bias, so those components, if included in the state, are set to zero. 

Calculation of the W- Matrix 

In rendezvous navigation it is the relative state which is 
measured and used to update either (or both) of the inertial vectors. 
Associated with the relative state is the relative covariance matrix. 

As an example the W matrix for a 9-dimensibnal state including con- ’ 
stant sensor bias is computed. 

The error in the relative state is due to errors in the sensor 
measurements r, J3, and 0 and to errors in the transformation matrices, 
^R-SM’ measured quantities'- r^, and 

0^ include noise a and bias n. 
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9.8.2 Relative State Updating (cont*d) 


V) = ( 5?j.i n^. .ng ) 

Errors in the transformation matrices are due to stable member 
misalignment and structural deformation between the sensor and the 
navigation base. These errors in the two matrices Mr.sjvi 
^NB- m expressed as Cp and £,j. These pseudo -vectors represent 
one standard deviation small rotations about three othogonal axes. 

From the values of a , n > ^ and e -ptwo diagonal 9x9 matrices 

pear in SIG if each of those components of bias is to be estimated 
(as is done here), otherwise they appear in GAM. 

Combinations of several 3x3 partial derivative matrices 
make up a 9 x 9 matrix relating state error to the matrix SIG. Those 
component matrices will now be computed. 

The partial derivative matrix of relative position error in 
the sensor frame due to error in |3 and 9 , DRDMg, is computed 
by simply taking the necessary derivatives of the geometric relations: 


SIG and GAM are formed. It should be noted that and p 


k,0 
^k, 1 


•k,2 


^k ^k 

-rj^sine^ 

cos cos 


Combined with transformation matrices the partial derivative matrices 
allow the partial derivative matrix of relative position error in the 
inertial frame to be written: 


DRDM, 

k 


T T 

= M M 

R-SM SM-NB k 


M 


T 

NB-m 


DRDMs 
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9.8.2 Relative State Updatiiig (coiitM) 


The dependence of the velocity deviations 6v^ 2 '*'^0 

position errors must be computed. The two matrices DVDS^ and 
DVDR^ are derivatives of Lambert's solution for the velocity at the 
second point. They may be computed from' values of semi-major 
3^xis^ Ifaj, eccentric anomalies, and S and C (Battin's special 
transcendental -functions ) found in the Lambert Routine, 

O' . = reciprocal of semi -major axis 

X = (Ej^-E 2 )/ (E = eccentric anomaly) 

y - = x^ / c 

g , ^2 . 

V Battin's special transcendental functions 

C{ax^) '' 

Using these variables -and the following definitions proceed; 


^1 

— 


^2 


N ■ 

A 

^1 

= 

UNIT (r^.) 

y\ 

^2 

= 

UNIT (r^) 

q 

= 

v! 2 - ax^c 



,(c - 3S)/ (2ax^) • 

Dc 

= 

(1 -ax^ S - 2C)/ (2ax^) 


= 

- sin { sfa x^ ) / (4 q '1 u x^ ) 

Qd . 


(3 xS yD(^)/{2C^) - x^ Dg 

F 

= 

4<‘/y'/“ 

H 

= 

y/ri-i 
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9.8.2 P>.elative State Updating (cont*d) 


G 

F H 

Y 

c 

F/tj^ - G/ 2y 

^ - 

-Gj a 

II 

0 *^ 

(2\/T) + 3 S x/(2C) 

D 

Qd + Qy Dq 

V-j^or = 



( + r^ ) Tj/ 2a 

II 

1-' 

( ('Ty"- Qy9 ) Vja + Qy r^)/ D 

= 

( (My"- Qy<l ) Vgo + Qy ) / D 

V^y = 

I'l - <1 Vjtt - O' Dq VjffX^ 

Vgy = 

^2 “‘1 V 2 ff - a Dq V 2 ax^ 

V^F = 

- F ( Vj a/ O' + V^y / 2y ) 

V' = 

- F {V^aj a + 2y) 

V 2 G = 


V^G 

Yj. V^y + v^or - P y r^/ 

DVDR2= 

G I + r^ V;^f'^ + r^ V^g'^ 

DVDRj^ = 

^ A T A T 


(I is the 3 dimensional identity matrix) 

Combined with DRDM^ and DRDM 2 the above matrices yield 
the 9x9 partial derivative matrix relating the state to the matrix of 
sensor random and bias errors. 
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9.8.2 Relative State Updating Ccont*d) 


DVDM^ = DVDB^ DBDMj^ 
DVDMg = DVDEg DEDMg 
DVDE = DVDMj^ + DVDMg 



DVDMg 

0 

DEDMg 

DSDS = 
(9x9) 

DVDMg 

DVDMj 

DVDE 


0 

0 

I ■ 


A second 9x9 partial matrix relates state errors to tm- 
estimated sensor bias and the two misalignments. The additional 
needed 3x3 component matrices are computed now. 


The matrix DRDE^g relates position error at the first "fix" 
in the sensor frame to misalignment between sensor and navigation 
base 


DEDE 


Ts i: 


-r 


’ ^TPS k, 2"^TPS k.l 


TPS k, 2 


^TPSk,l ‘^TPS k,-0 


• TPS k, 0 
0 


This matrix rotated' into the reference frame is: 


DRDEpj, Mr_sm 1 ^NB-m 

In the same way DEDE,j. 2 computed. 


9.8-113 



9.8.2 Relative State Updating (cont'd) 


The matrices relating stable member misalignment to error 
in position in the reference frame .DRDEp is computed in the same 
way. It consists of a matrix composed of elements of tlie relative 
position vector in the reference frame 

Using the chain rule allows the computation of the matrices 
relating velocity to the two misalignments: 


DVDE^ = DVDR^ DRDE^ 2+ DVDR^ DEDE^ ^ 

DVDEp = DVDRg DRDEp g+ DYDR^^ DRDEp ^ 

The dependence of estimated bias in r, jS and 6 on the two 
misalignments is given fay the following two matrices. 


DBDBrj, = DEDMg^^ DRDE^g ^ 


DBDEp - DRDMg-j ^SM-NB 1 ^R-SM^^°®TS 1 


The complete 9x9 partial matrix is thus: 


DSDG 


DRDMg 

DRDEq. 2 

DRDEp 2 

DVDE . 

DVDE.j. 

DVDEp 

I 

DBDE.J, 

DBDEp 


The covariance matrix of errors in the relative state in the reference 
frame is: 
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9.S,2 Relative State Updating (cont'd) 



DSDS SIG DSDS"^ + DSDG GAM DSDg"^ 


6b 


The W matrix can be found from the above covariance matrix by 
forming a diagonal matrix consisting of the square roots of the 
diagonalized covariance matrix. If the rows of the matrix RV are 
eigenvectors of COV; that is RV is defined to be; 


'11 




'22 


etc 


= RV COV EV 


The W matrix is then; 


E 


'11 


W = RV 


E 


'22 


etc 


( Note: The above indicates symbolically the definition of 
W but the actual routine to compute W may or may not use the above 
steps ). The vector state the time and the relative 

W matrix are returned to the calling program. 
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9.8.2 Relative State Updating (contM) 


3, DETAILED FLOW DIAGRAMS 

'This section contains detailed, flow diagrams for the Auto- 
matic Initialization, Routine and Measurement Incorporation Routine 
of the Co-orbiting Vehicle Navigation Module. A nine dimensional 
W-matrix is computed. The three adjoined elements are for constant 
sensor bias in r, and 6 . ' These particular biases were chosen only 
as an example. 

Two routines used are not yet documented: the Lambert 
Routine and the Eigenvalue Routine. 
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Figure 3a DETAILED FLOW DIAGEAM,MEASUEEMENT INCORPORATION ROUTINE 
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9.8.2 Relative State Updating Ccont*d) 



Figure 3b DETAILED FLOW DIAGRAM. MEASUREMENT INCORPORATION 

ROUTINE 


9.8-118 






Figure 3c DETAILED FLOW DIAGRAM,MEA.SUREMENT INCORPORATION 

ROUTINE 
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9.8.2 Relative State Updating (cont*d) 



Figure 3d DETAILED FLOW DIAGRAM, MEASUREMENT INCORPORATION 

ROUTINE 
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Figure 3e DFlTAlliED FLOW DIAGRAM, MEASUREMENT INCORPORAHON ROUTINE 
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Cycle to 


Figure 3f DETAILED FLOW DIAGRAM^MEASUEEMENT INCORPORATION 

ROUTINE 
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9.8.2 Relative State Updating Cconl:*d) 


ENTER 



Figure 4a DETAILED PLOW DIAGRAM.AUTGMATIC INITIALIZATION ROUTINE 
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9.8.2 Relative State Updating (cont'd) 



Figure 4b DETAILED FLOW DIAGRAM .AUTOMATIC INITIALIZATION ROUTINE 
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Figure 4c DETAILED PLOW DIAGRAM.AUTOMATIC INITIALIZATION ROUTINE 
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9.8.2 Relative State Updating (cont'd)* 



Figure 4d DETAILED FLOW DIAGRAM, AUTOMATIC INITIALIZATION ROUTINE 
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9.8.2 Relative State Updating (cont'd) 



— - ■ » 

= 3xySD^/(2C?) - Dg 

F 

= \i^/yy « 

H 

= y/rj -1 

G 

= F H 

Y 

c 

= F/ - G/2y . 

A 

c 

= -G/o 

Q 

y 

= aj (2 |y<) + 3x3/ (2c) 

D 

= + Qy « Dq 



Vga 

= (r^ + ^2)r^/2a 

^ ‘2 

= ((Ty -Qy Q) +Qyr^)/D 

V2Qrx^ 

= {(i-y -Qy Q) Vgc +Qyr 2 )/D 

V^y 

= - Q Vjtt - a Dq V^q-x^ 

V 

- - QV2« - a Dq V2«x 

VjF 

= - F + Vj^y/ 2y) 

V 

= - F ( 0? + Vgy (2y) 

Vj^G 

= Y^ Vy^-A^y^^-Fyrj/rj 


Figure 4e DETAILED FLOW DIAGRAM. AUTOMATIC INITIALIZATION ROUTINE 
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9*8.2 Relative State Updating (cont*d) 



'^I is the 3D identity matrix 
0 is the 3D null matrix 


Figure 4f DETAILED FLOW DIAGRAM, AUTOMATIC INITIALIZATION ROUTINE 
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9 ‘8. 2 Relative State Updating (contM) 



Figure 4g DETAILED FLOW DIAGRAM,AUTOMATIC INITIALIZATION ROUTINE 
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9.8.2 Relative State Updating Ccont’d) 



Figure 4h DETAILED FLOW DIAGRAM, AUTOMATIC INITIALIZATION ROUTINE 
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9*8.2 Relative' State Updating (cont*d) 


4. SUPPLEMENTARY INFORMATION 

The equations presented in this report are the results to date 
of studies performed under a G & C shuttle task to develop G & N 
equations for automatic rendezvous. Two fundamental approaches were 
taken in these studies: (1 ) automate proven Apollo rendezvous naviga-' 
tion equations; ( 2 ) develop optimum rendezvous navigation equations^ . 
By presenting the equations in the general form shown, they are made 
to reflect formulations developed using both approaches (1) and (2), 
Analyses performed to evaluate the filter equations are reported in the 
references. 

To complete the automation of the Apollo filter, an automatic 
mark reject routine remains to be formulated. 


References 

1, Muller, E,S., Kachmar, P, M, , The Apollo Rendezvous 
Navigation Eilter- Theory, Description and Performance, 
Vol. lof2. Draper Lab Report R -649, June 1970, MIT, 

2, Muller; E,. and Kachmar, P, , STS Progress Report - 
Rendezvous Studies, Memo 23A STS #11-70, MayJ970, MIT, 

3, -Phillips,. R. , Lambert Determination of the Relative State 
for Rendezvous, -Memo 23A STS #6-70, 28 April 1970, MIT, 

4, Tempelman, 'W, , Non-Cooperative Rendezvous Trajectories, 
23A STS Memo #4-70, 30 April 1970, MIT. 

5, Sears, N, E. , et, al,„ STS Avionic Specification Presenta- 
tion, C-3397', 12 November 1969, MIT. 

6, Users Guide to Minkey Rendezvous, E-2448, 17 July 1970, 
MIT. 
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9.8.3 Rendezvous Guidance (TBP) 

9.8.4 Rendezvous Attitude Control (TBP) 
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9.9 STATION KEEPING MISSION PHASE 


Station keeping begins with the targeting for braking as the Shuttle 
approaches the target vehicle sometime after TPI. This phase includes 
braking targeting, braking, positioning for station keeping, automatic 
station keepings repositioning to station keep at a different position 
relative to the target vehicle and/ or in preparation for docking . 
Automatic station keeping here means the preservation of a precise 
relative position with the target vehicle with no requirement for manual 
commands. Automatic station keeping may occur before docking, after 
docking, and on missions in which docking does not occur. This phase 
ends when the docking maneuver begins, or when the shuttle is separated 
from the target vehicle with no intention of preserving a precise 
relative position with it. 

The software functions required in this mission phase are the 
following t 


1. Estimate relative state of target vehicle based on 
external measurements. 

2. Estimate absolute states of both shuttle and target 
vehicle . 

3. Compute (target) the braking A V(s) required, their 
direction, and the time(s) of l^ition. 

4. Execute braking maneuver by commanding engine (s) on, 
providing attitude commands during braking, and 
commanding engine (s) off, 

5. Powered flight navigation. 

6. Automatically preserve a relative position and attitude 
with the target vehicle by periodic RCS engine on/off 
commands with a minimum- fuel technique. Spatial and 
angular requirements and allowable variations during 
automatic station keeping are TBD. 

7 . Provide RCS engine commands to achieve commanded 
attitude during AV maneuvers and during coast periods 
(digital autopilot) . 


Repositioning for docking maneuver initiation, for a separation maneuver, 
or for station keeping at a different relative position is assumed to 
be a manual function and therefore no software for performing these 
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maneuvers automatically is required'. 

A- f lox<7 of software functions during station keeping appears in 
Figure 1. Some functions overlap with other'.mlssion phases and only 
those equations not provided in earlier sections are discussed here. 

9.9.1 Relative State Estimation (TBD) 

9.9.2 Station Keeping Guidance (TBD) . 

9.9.3 Station Keeping Attitude Control (IBP) 
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I 

U) 



g_= estimated position, velocity and attitude 


(5nd 

Beacon 


Actual 
Atti tude 


Figure 1, Flow of Software Functions During Station Keeping 
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DOCKING AND UNDOCKING 


The two distinct events are described as one phase since the 
events are essentially reversals of one another. The distinction between 
the docking event and terminal rendezvous is the point at which the man- 
euver defined by the docking constraints on such variables as range, 
ettitude, and attitude rate is Initiated. 

The mode of docking is still open; that is, it has not been 
determined whether the docking will be performed manually or automatically, 
with a manual backup capability. The GN&C software functions to be per- 
formed during this phase are based on an automatic docking with manual 
backup. The docking SW functions are; 


a) 


b) 

c) 

d) 

e) 


Specxfic force integration updates of relative states 
uring tr^slational burns. This function will maintain 
the relative state between the orbiter and its co-orbiting 
target during orbiter bums. ^ 


Maintain attitude-hold about a desired orientation. 

Compute and command steered-attitude RCS AV maneuvers for 
docking. 

Make high-frequency steering estimates between guidance 
•samples for docking. 

Provide three-axis translation control. 


The SW functions for undocking are: 


a) Configure all GN&C systems for the next mission phase. 

b) Schedule undocking. 

c) Compute and command AV translations. 

d) Provide capability to advance inertial state vector from an 
initial state to a final state. 

e) Provide, for specific force integration updates of relative 
state during burns associated with undocking. 

f) Compute and command attitude-hold RCS AV maneuvers. 

Figure 1 displays a function flow diagram of the docking GN&C software 
functions . 
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9.10 DOCKING AND ‘UKDOCKING (con't) 

Presently, no specific sensors for automatic docking have been 
baselined. However, control laivs and a navigation routine have been ap- 
proved by the GN&C Software Equation Formulation and Implementation Panel. 
These equation formulations are described in the following references. 

a) E. T. Kubiak, "Automatic Docking Control Law," MSC 
EG2-3-71, date 5 January 1971. 

b) E. P. Blanchard, G* M. Levine, "Docking and Undocking 
Navigation," MIT No. 2-71, dated January 1971. 
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9 . 10 DOCKING AND UNDOCKING ( cont ’ d) 





Figure 1 

Overall Functional Flow Diagram 
for Docking and Undocking 
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9.10 DOCKING AND UNDOCKING (cont'd-) 

SPACE SHUmS 

GN&C SOFTWASE EQUATION' SUBMITTAL 


Software Equation Section Docking and Un.docV~?rig No. 

Function Relative Navigation 

Module No. ON3 F unction No. -2, -5^ -8 (MSC 03690) 

Submitted By: E. P. Blanchard, G. M. Levine C o. MIT 

(Name) 


Date ; January 1971 

NASA Contact; W. H. Peters _0rganizatiqn_EG2 

(Name) 

Approved by Panel II I K. J. Cox Cat^ Dat e 3/10/71 

(Chairman) 

Summary Description: The objective of the Docking and Undocking 

Navigation Program is to use the data from the docking sensor to 

determine the relative position and attitude of the target vehicle 

with respect to the shuttle. These quantities and their rates are 

computed periodically and used in the generation of guldan^^ 

commands during both the docking and undocking procedure. 

Shuttle Configuration; (Vehicle, Aero Data, Sensor, Et Cetera) 

Assumes a docking sensor which me asures the azimuth and elevation 
angles to each of four sources located on the target vehicle. 

Comments : 

(Design Status) The algorithm for source identification is TBD. 

(Verification Status) Open— loop testing has been performed simulating 
the sensor-target geometry and the sensor. . 

Panel Comments ; The equations are baselined subj ect to the qualifica- 
tion that they are based on a sensor configuration which has not been 
baselined. Also, the range and range rate computations must be co- 
ordinated with those in the Automatic Docking Control Law. 
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9 . 10 . 1 Docking and Undocking Navigation 


1, INTRODUCTION 


The objective of the Docking and Undocking Navigation 
Program is to use the data from the docking sensor to determine the 
relative position and attitude of the target vehicle with respect to the 
shuttle. These quantities and their rates are computed periodically 
and used in the generation of guidance commands during both the 
docking and undocking procedure. 

The docking sensor measures- the azimuth and elevation 
angles- to each of four sources located on the target vehicle.. The* 
configuration of these four sources is designed to permit recognition 
of one source by its angular position relative to the other sources 
under all allowable rotations of the shuttle with respect to the target 
vehicle within certain restricted operating limits. As long as the 
operating -limit restrictions are satisfied, it is not necessary for the 
sensor to identify, individually the sources; i. e. , the sensor portion 
of the system does not have to associate a particular source’ with 
each set of azimuth and elevation angles, that process can be ac- 
complished computationally. Furthermore, in this case, the data 
from only three of the four sources are required to obtain a complete 
relative position and attitude solution. The velocity and attitude rates 
are determined by numerically differencing two position and attitude 
solutions'. 

On the other hand, if the operating-limit restrictions are 
violated, then the equations have multiple solutions, and all four sets 
of data must be used to resolve the ambiguities. 

An additional reason for the presence of four sources is to 
provide an option for selecting the best combination of three sources; 
i, e. , at close rsmge to permit selection of sources which fall within 
the sensor field of view, and at long range at provide a combination- 
of three sources which yield a more accurate solution. 
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9.10.1 Docking and Undocking Navigation (con’t) 


A 
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NOMENCLATURE 

Intermediate matrix 
Azimuth angle to source i 
Intermediate matrix 
Cos 40° 

Elevation angle to source i 
Rate indicator 
Flag used in iteration 
Flag used in rate calculation 
Negative radicand indicator 

Unit vectors along shuttle coordinate axes 


Unit vectors along target vehicle coordinate axes 


0.4 or 2. 5 depending on selected source set 
Index used in rate calculations 
Transformation matrix 
Index used in rate calculations 
Element of M 

Index used in rate calculations 
Source set indicator 
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r 
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r. 

1 


r.. 

•-1J 



r 

new 

^old 

S 

z 

z 

1 

* 

'^1 

^3- 

Ar 

At 


€ 



P 


Relative position vector between docking hatches 

Rate of change of r 

Vector from sensor to source i 

Magnitude of 

Vector from source i to source j 
Magnitude of r„ 

Maximum value of 

Iteration interval end points 

Sin 40° 

Trial value of r^ 

Vector from sensor to shuttle docking hatch 
Vector from source 1 to target vehicle docking hatch 

■Vl' ^ 2 ^ ^3 

Rate of change of . 


Rotation angles 
®1 ■ ^1 

Previous value of Ar 
Navigation cycle time- 
Error 'tolerance 

Angie between lines -of-sight to sources i and-j 
Scaling factor 


Subscript S Shuttle coordinates 

Subscript T Target vehicle coordinates 
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SOURCE CONFIGUEATJON AND OPERATING LIMITS 


In this section, the configuration of the four sources on the 
target vehicle is described, and the operating limits under which a • 
unique relative position and attitude solution can be obtained is dis- 
cussed. 

Refering to Fig. 1, define a coordinate system fixed in the 
target vehicle with origin at source 1; X axis parallel to the docking 
axis; and i.yT' — ZT vectors along the three axes. Let 

r.. be the vector from source i to source j. Then the locations of 
sources 2. 3, and 4 are defined by 


/ cos 40 
-12T 40*^ 


List 


cos 40 


sin 40 


-14T 


j cos 40°\ 
= 2.5 p /-sin 40° j 
\ 0 / 


where the subscript T denotes target vehicle coordinates and p is a 
scaling factor. 


In order to discuss the restricted operating limits, define a 
coordinate system centered at the docking sensor in the shuttle with 
unit vectors i_j^g. LyS' izS axes. Again, let the X axis 

be parallel to the shuttle docking axis. Let y y^, and be the 
three rotation angles which make the shuttle coordinate system pa- 
rallel to the target vehicle system (the condition required for docking); 
i. e. , a rotation of the shuttle system about the X axis through an 
angle y then a rotation about the resulting Y axis through an angle 
y^, and finally a rotation about the resulting Z axis through an angle 
Yg make the two systems parallel. 
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If the X ( docking) axis of the shuttle is kept within 30° of 
the target vehicle docking axis, then an identification of the four 
sources can be made. Figure 2 illustrates the appearance of the 
sources for various relative vehicle attitudes for the case of zero 7 ^. 
The center illustration shows the appearance of the sources when the 
two vehicles are properly aligned for docking; the other eight illus- 
trations show the appearance at various points on the surface of the 
30° cone defining the operation region.' 

For all relative vehicle orientations within the operating 
region, the following two facts hold: 

1 ) Sources 1, 2, and 4 lie on a straight line. 

2) The observed distance between sources 1 and 2 always 
lias the same ratio with respect to the observed dis- 
tance between sources 1 and 4. 

These two facts permit identification of the four sets of paired azimuth 
and elevation angles with the four sources. 

The source configuration has also been selected to assure 
that for all relative vehicle orientations within the 30° operating re- 
gion the distances from the sensor to the sources will satisfy the 
relationship r^ < r^ < r^ < r^. This relationship provides the resolu- 
tion of the multiple solutions which would otherwise exist in the 
navigation equations. 
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Figure 2 APPEARANCE OF SOURCES VS RELATIVE 

VEHICLE ATTITUDE 
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3. FUNCTIONAL FLOW DIAGBAM 

The sequencing of functions performed by the Docking and 
Undocking Navigation Program is described in this section and illus- 
trated by the functional flow diagram in Fig. 3. 

The program is called periodically by the Docking and Un- 
docking Guidance Program". The first function performed is to 
identify the four sources from the two facts discussed in Section ^. 
Next, the appropriate sources are selected and the unique relative 
position and attitude solution is determined. Included in tliis solution 
is the relative position of the two docking hatches. The final step is 
to compute velocity and angle rates by differencing two solutions for 
position and angle. 


4. PROGBAM INPUT-OUTPUT 

The required inputs to the program are the four sets of 
azimuth and elevation angles of the four sources relative to the dock- 
ing sensor; and two indicators, the first of which indicates which of 
the two combinations of three sources ( 1, 2 , and 3 ) or ( 1, 2, and 4 ) 
have been selected, and the second is used in the rate calculations. 
The outputs of the program are solutions for the relative position of 
the two docking hatches’, the rotation angles between the two vehicles, 
and the rates of change of these quantities. 

Input Parameters 


Four sets of paired azimuth and elevation angles but not 
identified with any of the four sources 


e^) 

{ag, eg) 
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Enter from Guidance 



Exit to Guidance 


Figure 3 FUNCTIONAL FLOW DIAGRAM 








9.10.1 Docking and Undocking Navig ation (con*t) 


The elevation angle is the angle between the line-of -sight and the XY 
plane of the shuttle coordinate system. The azimuth angle is the angle 
between the X axis of the shuttle coordinate system and the projection 
of the line-of -sight on the XY plane. See Figure 4. 


P 


Source set indicator 


{ 2 if selected source set is ( 1, 2, 3) 
4 if selected source set is (1,3,4) 


Number of cycles separating 
Rate indicator = differenced solutions in rate 

calculations . 


Output Parameters 





1 = (71-72^73) = 
X = <7i>72>73) = 


Position vector of target vehicle docking 
hatch relative to shuttle docking hatch in 
shuttle coordinates 

Rate of change of £g 

Rotation angles 

Rates of change of rotation angles 


5. DESCRIPTION OF EQUATIONS 


The computational sequence during the Docking and Undock- 
ing Navigation Program and the related equations are described in 
this section. These equations are recomputed every guidance cycle. 
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5. 1 Source Identification ( TBD > 

The first step in the program is to associate each of the 
four sets of azimuth and elevation angles with a particular source. 
The procedure for performing the association is based on the two 
facts discussed in Section 2; i. e. , 

1 } Sources 1, 2, and 4 lie on a straight line. 

2 ) The observed distance between sources 1 and 2 has 
the same ratio with respect to the observed distance 
between sources 1 and 4. 

The algorithm used is TBD. 


5.2 A ngles Between Lines -of -Sight 

The cosines of the three angles between the lines -of-sight 
from the sensor to the sources in the selected set ( based on indica- 
tor p ) are computed from 


cos 6 .. = cos e. cos e cos (a. - a. ) 

1 ] 1 j 


+ sin e. sin e. 
1 J 


for 


ij = 13, Ip, and 3p 
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5 . 3 Distances to Sources 

• Let' £2* £3^ and b® the vectors from the sensor tc 
the four sources. The magnitudes of the three vectors associatec 
with the selected sources satisfy 



or 



These equations are solved by. an iterative interval -halving process in 
which a trial value of r^^, is -used as input to compute an output= 
value of r^ by means of 

rg . cos 

“■p ■ ‘■3 «3p i \|‘-3p' 

'•l ' “-p «lp - f ip' 

Where the upper and lower signs correspond, respectively, with p=4 ' 
and p=2. Agreement between and Indicates a correct solution. 
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The iteration is initiated by computing the maximum possible 
value ior based on the sensor measurements 


"M , 5 , 

N1 - cos 

Then, using as the first value for values for and r^ 

are computed from Eq. { 1 ), During these calculations, it is possible 
for one of the radicands to be negative, in which case the selected 
value of s^ is too large. If this occurs, the value of is halved, and 
the' computations are repeated. The process continues until three 
real numbers are obtained for r„, r^, and r, as functions of s.. (It 

0 p 1 1 

should be noted that once a value of which produces a real solution 
has been determined, then all smaller values of s^^ will also yield a 
real solution. ) 

The difference between the input and output values of r^ is 
computed from 


Ar = Sj - r^ (2) 

Assuming that a negative radicand did not occur, the value of 
Sj is halved, and new values for r^, m, r^^, and Ar are computed. If 
no sign change in Ar occurs, then s^ is again halved and the procedure 
repeated until a polarity change in Ar occurs. When the sign change 
does occur, the last selected value of s^^ is increased by one half its 
value and the polarity of the new resulting Ar is tested. This interval- 
halving procedure, increasing or decreasing s^ by one half of each 
increment taken, is repeated until the difference Ar is less than the 
desired error level e. 

This procedure is based on the fact that Eqs. { 1 ) and (2 ) 
represent Ar as a continuous function of If there are two values 
of s one of which yields a positive value of Ar and the other a nega- 
tive value, then there is some value of between these two values 
for which Ar is zero - the desired condition. 
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During the first calculation of Ar, if a negative radicand re- 
sultSj then a special procedure must be followed after the value of 
which yields real values is found. Whereas in the first case it is 
known that the correct value of is not larger than in this case 
the solution could be larger than the value of s^ for which real (but 
incorrect) values of r^, r^, and r^^ resulted. This ambiguity is re- 
solved by performing one pass through Eqs. ( 1 ) and ( 2 ) with s ^ equal 
to zero. Comparison of the sign of the resulting Ar with the sign of 
the previous Ar indicates whether should be increased or de- 
creased. This same procedure is used if, during an increase in 
a negative radicand occurs. 

The details of the iterative procedure are shown in the flow 
diagrams of Section 6. 


5. 4 Source Position Vectors 

The position vectors of the' three selected sources are ob- 
tained from 


r-o = r. 
— iS 1 


cos e. cos a. \ 
1 1 


cos sin 


sin e. 


/ 


{i «= 1, 3, p) 


where the subscript S denotes shuttle coordinates. 


5.5 Transformation Matrix 

The transformation matrix M from shuttle to target vehicle 
coordinates is computed from 

= AB 

where 


•*■ = <£-133 £lpS £l3S^£lpS^ 


9.10-19 



9.10.1 Docking and Undocking Navigation (con't) 



S = sin 40*^ 


f 0.4 if p = 2 
^2. 5 if p = 4 


-13S ■ ^3S ■ -fS 
-IpS " “ -IS 


5,6 Rotation Angles 

The rotation angles 7 .^, 7 ^^ and 7 ^ are obtained from 


.sin ^ (nigj) 


-1 "^21 
-sin ( 

cos 7 2 

. ■ -1 ^32 

-sin ( 

cos 7 „ 
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where 11132 are elements of M according to 


^11 

“■12 

“13 

“^21 

“22 

“23 

“^31 

“32 

“33 


5. 7 Relative Position Vector Between Docking Hatches 

The position of the target vehicle docking hatch relative. to 
the shuttle docking hatch is computed from 

£s ■ - Zs ♦ 'is 

where y and z are the locations of the shuttle and target vehicle dock- 
ing hatches relative to their respective coordinate system origins, and 
the S and T subscripts indicate shuttle and target vehicle coordinates. 
Note that yg and z,p are fixed constants. 


5.8 Velocity and Attitude Rate 


The estimated relative velocity and estimated relative at- 
titude rate of the two vehicles are computed by differencing the 
current relative position and attitude solution with the solution f 
cycles in the past as follows: 



Yi(t) 


y .(t - fAt) 




/ fAt 


(i = 1, 2, 3) 



£g ( t ) - £g ( t - f At ) 


/ fAt 
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During the first cycle, no rate information can be computed,, 
and during cycles 2 through f, the current and the first solutions are 
used in the calculations. 

This procedure provides smoother estimates of the rates 
from cycle to cycle than if successive values of relative position and 
a.ttitude were used. 


6. DETAILED FLOW DIAGRAMS 

This section contains detailed flow diagrams of the Docking 
and Undocking Navigation Program, 
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Figure 5c DETAILED FLOW DIAGBAM 
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Figure 5d DETAILED FLOW DIAGRAM 
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^2 ~ ^ 

-1 ’^21 

73 ;= - sin ( 

cos 72 



Figure 5e DETAILED FLOW DIAGRAM 
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Figure 5f DETAILED FLOW DIAGRAM 
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7. SUPPLEMENTARY INFORMATION 

The Docking and Undocking Navigation Program described 
in this report has been operated as an open loop, simulating the 
sensor-target geometry, the sensor, and the computations yielding 
as outputs the relative state vector and attitude between vehicles. 

The program is valid and the configuration chosen performs as ex- 
pected. A chart and tabulated results appear in Ref. 1. 

It is planned to continue the present program effort to provide 
a closed loop capability which will include a guidance law* for Dock- 
ing and Undocking, and an autopilot with capability to operate with the 
guidance law and the vehicle and engine characteristics. The navi- 
gation program will be modified to incorporate Kalman Filtering 
which should enhance the navigation and provide better assessment 
of the relative state vector. It is also planned to add a scale change 
or zoom capability to the sensor model used such that improvement 
in the accuracy of the state vector can be achieved at long ranges. 


A simplified guidance law will be implemented initially with growth 
to more sophisticated guidance laws as deemed necessary. 
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Eeference 


1. Blanchard, Earle P. , NAS 9-10268 Automatic Docking GNSc C 

Equation. Development, 21 December 1970, 70-408L-7. 
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SPACE SHUTTLE 


GH&C SOFTWARE EQUATION SUBMITTAL 


Software Equation Sectio n Docking and Undocking S ubmittal No, 3 
Function Automatic Docking Control Law 


Module No. 0C4 F unction No, “A, -6 (MSC 03690) 

Submitted B y: E. T. Kubia k Qq, MSG/GCD 

(Name) ~ 

Date : January 26, 1971 

NASA Contact ; W, H, Peters Organization EG2 

(Name) 

Approved by Panel II I K, J, Cox p at e January 26, 1971 

Sunn^ry Description; The automatic docking control laws provide the 
attitude and translational commands for the docking procedure which 
is defined to- begin at a range of 1000 ft. The procedure involves 
two sequential control tasks. The first brings the orbiter within 
^atlonkeeping range (-150 ft.) and the second accomplishes docking 
with minimura docking hardware contact position dispersions. 

Shuttle Configuration: (Vehicle, Aero Data, Sensor, Et Cetera) 

No docking sensor configuration is defined but jet accelerations 
are assumed. 


Comments : 

(Design Statxis) The design is in the conceptual stage with required 
filters still to be designed. 


(Verification Status) Will be simulated on an orbiter docking 
engineering simulator. 


Panel Comments : The range, range rate, and relative attitude computations 

in these equations must be coordinated with similar computations in the 
Docking and Undocking Navigation equations. 
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Automatic Docking Control Law 


1. Introduction 

The docking procedure is defined to begin at a range of approxi- 
mately 1000 feet. From this points there are two sequential control 
tasks. The first task is to bring the orbiter within stationkeeping 
range, say 150 feet, with a lateral displacement of 10 feet or less from 
the desired approach path and relative rates of one half ft/sec/axis or 
less. The second control task is’ a successful docking with minimum 
docking hardware contact position dispersion and transmitted impulses. 

Significant improvements over the original control law (Refer- 
ence 1) are (1) minimum use of relative angle measurements which have 
large errors, (2) direct control of the probe tip which provides tighter 
control, and (3) reduced time for the docking procedure due to improved 
logic. The first two points are also discussed in the reference. 

In generating this control law, the following assumptions have 
been used as ground rules: 

a) Measured quantities available from the sensors are 

range, R; LOS (line-of-sight) angles for pitch, a, 
and yaw, and relative orb iter /tar get attitude 
(<J>R> 0R» . As the orbiter is to be autonomous, 

no other information (e.g., target position or 
attitude) is available from ground tracking or 
computer initialization. 

b) Range and LOS angle measurements will have greater 
accuracy than relative attitude angle measurements 
(particularly at longer ranges) . 

c) It is desirable to have at least a brief station 
keeping period prior to the final phase (assumed 
to begin at 100 ft range) of docking, providing 
the opportunity for a final check of thrusters, 
docking mechanisms, GN&C systems, and sensor 
systems. 

d) The docking procedure begins at approximately 
1000 ft range and should conclude in 5 to 10 
minutes (plus any time spent in the station 
keeping mode) . 


9.10-32 



9.10.2 Automatic Docking •Control Law (c'on^t)' 


e) Sensor measurements provide the only available 
information with regards to the passive vehicle's 

■ relative state (no data link) . 

f ) It is assumed, that the target vehicle is under 
attitude control and that any target vehicle 
motion due to attitude control limit cycling is 
negligible (a good assumption for Cite control). 


Nomenclature 


a 

Translational acceleration 

a 

LOS pitch angle 

3 

LOS yaw angle 

K 

Factor in phase-plane switching lines 
representing the relative importance 
of time vs. fuel minimization 

A 

Distance along +X body axis from 
orb iter c.g. to sensor location 

LOS 

Line-of-sight 


Relative orblter/target roll attitude 

■'r 

Relative orblter/target yaw attitude 

R 

Range 

T 

Total closure time 


Relative orb iter /target pitch attitude 


±'i' yaw torques 


±9 pitch torques 

u 

y 

±y thruster forces 

u 

z 

. ±Z thruster forces 

-BODY 

Orbiter body rate 


9.10-33 



9.10,2 Automatic Docking Control Law (con’*t) 




X. 


0 


x„ 


X » 
eg 



\cs’ ^LCS 



LOS angular rate 

Initial separation distance 

Initial closing rate 

C.G. position errors 

Position errors in LOS coordinate 
system 

Probe position errors 
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2* Coordinate System Definition 

Before proceeding to equation formulation, the following coordi- 
nate systems must be defined (see also Figure 1). 

a) Body coordinate system (BCS) - origin at c.g. of 
+X axis towards nose' along centerline, +Y .towards 
right wing, +Z doxm. 

b) Sensor coordinate system (SCS) - sensor and docking 

mechanism location assumed coincident along +X body 
axis at distance Si from orbiter c.g., which also 
defines the origin location. Direction of axes, 
same as body axes. ' , 

c) LOS Coordinate System (LCS) - origin same as the 
SCS. Direction of axes defined by LOS pitch and 
yaw rotations from SCS +X axis.' 

d) Target coordinate system (TCS) - origin located 
at passive vehicle docking mechanism assumed 
coincident with reflectors. -X axes defines the 
desired final approach path. Y and Z complete 
the right hand system 


3. Functional Flow Diagram 

The sequencing of functions performed by the Automatic Docking 
Control Law is described in this section and illustrated in the functional 
flow diagram. in Figures 2a and 2b . 

The program calculates the probe to target vector and determines 
whether Phase 1 or Phase 2 control is desired-. If Phase 1 control is re- 
quired, calculate the position and velocity errors for phase-plane control 
using the sensor measured pitch and yaw LOS angles, c.g. to target range, 
and the estimated vehicle to target, attitude. Based on these values for 
position and velocity errors, entier the X, Y, and Z-axis phase-plane 
control logic and compute translational commands. 

For Phase 2, control, compute the range position error using the 
sensor measured pitch .-and yaw LOS angles, c.g. to target range, and the 
estimated vehicle to target attitude. Passing this signal through a 
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Phase 2 Region 
(see -Figure 2b) 


Figure 2a. Phase I Control Functional .Flow Diagram 
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Phase 2 Control Region 



Figure 2b. Phase II Control Functional Flow Diagram 
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filter, obtain the rate error. Enter the range control phase-plane logic 
to compute jet firing times for X-axis translation control. Compute the 
lateral position errors of the probe and eg. and determine the res- 
pective rates by a filtering routine. Enter the c.g. and probe phase- 
plane logics to obtain .coordinated ±Z thruster firings and ±6 pitch ' 
torques for Z-axis and pitch control, and coordinated ±Y thruster firings 
and if yaw torques for Y-axis and yaw control. 


'+• Program Input-Output 

The docking sensors have not been baselined, buf in this develop- 
ment, basic inputs have been identified. These inputs include range, 

LOS pitch and yaw angles, relative orbiter/target attitude, body rates, 
the distance between the orbiter c.g. and probe as measured along the 
+X body axis, and estimates of the RCS jet control authorities. The 
outputs of the program are RCS jet firing times. 


Input Parameters 

^ Range between orbiter and target vehicle 

^ LOS pitch angle 

3 LOS yaw angle 

Relative orbiter/target roll angle 

®,R Relative orbiter/target pitch angle 

'*^R Relative orbiter/target yaw angle 


—BODY Orbiter angular rates 

{ 

Distance between orbiter c.g. and probe 
as measured along 4-X body- axis’ 

^ Translational acceleration capability 

of the orbiter (lateral and ±X body) 

translational acceleration along 
Y and Z axes 
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Uq, u^ RCS angular acceleration about pitch 

and yaw -axes 

Output Parameters 
t 

Region X RCS jet firing time (and sign) for 

various regions of the phase-plane 
logics 


5. Description of Equation 

5.1 Phase I Control 

Phase 1 is defined as the control period during which the 
orbiter is brought from some post rendezvous state (range about 1000 
feet) into the stationkeeping .state.' ‘ ' In the sequence of control actions, 
the first step is to define as a pitch/yaw reference, the LOS vector from 
the sensor to the target (i.e. , a = 0 = 0, see Figure 3)..- 

The roll reference is defined such that Z is parallel to 

(i.e., the relative roll angle is zero).. The attitude error, ((}> , a, 0) 

• 1 1 

wxll. change slowly due to relative motion and vehicle body rotation. 

This error will be measured and filtered once per second. Control logic 
will be basically the same as the CSM RCS, DAP with a deadband of 5°. 

When the vehicle's attitude is within the deadband for all three axis 
translational control is begun. 

In the translational .control formulation the TCS is considered 
to be inertial (orbiter mechanics neglected). The control problem is 
to translate the orbiter from its initial state to a limit cycle region 
which has as its position reference (-150, 0, 0) in the TCS. The ideal 
trajectory, time and fuel-wise, is the straight line between the initial 
condition and (-150, 0, 0) in the TCS. One of the more precise control 
processes which could be used to follow this trajectory is; 

a) Generate displacement and rate vector in the 
TCS from measurements and matrix computations. 
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PITCH PLANE 



YAW (Xg, Y^) PLANE 



Figure 3 

LOS Angle Definition 
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b) Select a delta V to (1) null velocity component 
normal to displacement vector, and (2) provide 
the desired closing rate along the displacement 
vector. 

c) Determine components of delta V in BCS and im- 
plement commands. 

d) Reiterate computations to null residual errors. 

The performance of such a process would be very dependent on the 
relative angle measurements used in numerous matrix multiplications. 

As these measurements are not highly accurate, particularly at initializa- 
tion range (1000 ft or more) , another process will be used which performs 
the same function and requires much less computation. 

a) Compute position error and vehicle relative rates 
in LCS. 

b) • Input" position errors and relative rates to phase 

plane switching logic to determine delta V commands 

c) Recycle according to some selected sample frequency. 

For this scheme. Figure 4a shows how the position error 

is determined to be 


^LCS “ ^sina 

Similarly, Figure 4b indicates 

\CS " V ^sing 

Finally, the X position error is 


= R + £cos0j^cos'i'j^ - 150 


The relative velocity of the orbiter with respect to the target 
vehicle in the LCS is equal to the negative of the derivative of (R + i) , 
As R is rotating in inertial space with an angular velocity of 
^*^103 “bODY^* ®^P^®ssion for the derivative is 


_d 

dt 


(R + i) 


LOS 


R + 




^ODY^ 


X R 


^ODY ^ 
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Figure 4a 
Calculation of Z. 
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Figure 4b 
Calculation of Y, 

r 
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Assuming ^ is colinear with the axis, then _£ = [a 0 o] 

Also , 



r^i 


r“i 


rn 

R = 

1 

0 o 

1 

%.os' 

f 

TO e 
1 

“body 

1 

CD 

1' 


which yields the following derivatives 


\cs 

-R 

• 

\cs 

-R(T^ + 3) - 

\cs 

* • • 

+ a) + 

Figures 5a and 5b show the geometry relating to 
. It should be noted in the position- and -rate 


LCS 


LCS 


B. and Z are always positive quantities. 


«bODY fBODY 


very nearly equal 0 and ^ . and further 
‘ 'K K 


as the body rates .may be known much more accurately than the relative 
angl 

by 6 


angle rates,. 6^ and may-be replaced iri the and computations 
"BODY ^BODY* 


The translational control law is based upon the parabolic switch- 
ing logic which is the optimal control for minimizing time and fuel for 
a 1/s or double integrator plant. Figure 6 illustrates this optimal 

logic -where the available control acceleration is u = fa. 

• • 

The factor K- in the ^ 4 ^^) switching curves is the rela- 

txve importance of time vs. fuel minimization (i.e. , increasing K decreases 
time and increases fuel and vice versa). As K ^ and 

^4^^^ ^ which is the time optimal solution (no coast zones). The 

docking logic will have separate values of K for range control (X) and 

lateral control (Y, Z) and those- will be selected from the allowable 
docking time constraints. 
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9 . 10 . 2 Automatic Docking- Control Law (cont’d) 



For a change in ij)|^ 

\cs "" '^R 



For a change in B> 

^LCS = -Re 

Total = -RCtI). + e) - '£iif 


Figure 5a 



Calcul ation 
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9.10.2 Automatic Docking Control Law (coat'd) 



Time-Fuel Optimal Control Logic 
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9*10.2 Automatic Socking Goiitrol Law (cdh’t) 

5. 2 Phase I .Range Control 

The maximrnn desired docking time is 5 minutes or 300 seconds and 
the control acceleration is .2 ft/sec (using two of the available four 
thrusters for finer control). Assuming a worst case initial separation 
and closing rate of 1500 feet and zero, respectively, the slowest possible 
path is shown in Figure 7 (A to B to C) . 



A to B is the control trajectory and B to C is the slowest 
trajectory in, the coast zone. Hence, the total closure time is 


T 


t 4* t 
AB BC 


The equation for total position change is. 




K . 2 

K + 4''^ BC 


Also, as the rate changes from A to B and B to C must be equal, 

K 


a t 


AB 


= a (■ 


K + 4^ ^BC 
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9.10.2 Automatic Docking Contro"! Law. (con’t) 


From these three equations, one can solve for K and K/(K + 4) 


K = 


% 

- 4X 


K 

K + 4 


0 


2X, 


aT - 2X 


‘0 


For -the given values of a, T and X^, K = 1 and K/ (K + 4) = 0. 02. (1) 

Finally, to permit coasting between some position deadband, 
®-®^ifications must he made to the optimal logic shown in Figure 6. 
Assuming a ±5 foot deadband the complete modified logic is shown in 
Figure 8. 


Figure 9 defines the phase plane switching regions*. In Region I, 
the desired control action is to drive the rate to 0.25 ft/sec (line seg- 
ment AB). The thruster firing time is determined from AX = at or 


t 


Region I 



5 X 1.25 


( 2 ) 


This firing time, of course, should be no longer than the control sample 
period to make use of feedback. Because of inaccuracies in modeling it 
may be necessary to include a hysteresis line bordering Region I to 
eliminate chattering (see Figure 9) . This will be determined at a future 
date. 


In Region II, the desired control action brings the state into 
the coast zone with an opposite rate sign (example trajectory CD shown 
in Figure 9). The desired rate change can be found by first writing 
the equation for the trajectory CD and then simultaneously solving this 
equation, with (X) . The* former equation is 



X-X’ 

1 





2a 







*2 

where 

X' 


+ ^ 

^0 . 



0 

2 

a 

and the latter 

X 

II 

(iUl 

^ K 

4 *2 
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9 ‘10 *2 . Automatic .Docking Control (cont’d' 
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Figure 8 


Phase 1 Range Control 
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9.10.2 Automatic Docking Control Law (cont*d) 
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9,10.2 Automatic Docking Control Law (con't) 


The intersection is' given by 


X 




(K + 4. X’ 
'■K + 2^ 2 




faKX’ 

K + 2 


Hence, the firing time is- given by 


t = ■.■>/ aKX» 

Region II V K 2 


+, /__JK 

a V K + 2 ■ a 


X (3) 


Finally , .Region III is designed to provide smooth limit cycle 
operation, the control action is to drive the rate to zero. Hence, 




(4) 


5*3 Phase 1 Lateral Control 

f 

Similarly, K' for lateral control, can also be found from the 
constraints, the acceleration , is .2 ft/sec^, maximum docking 'time equals 
300 seconds and maximum initial position and velocity errors of 150 feet 
and '3 ft/sec, respectively. Figure 10 shows the slowest trajectory. 
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9.10. 2 Automatic Docking Control Law (con* t) 


Again, three equations can be found to solve for K, 


time, ^ = ^AB ^BC 

position, Xq = -|Xq| 1+ — at^+Y^ BC 


rate, a 


K 


The equations for K and are found to be 

K 


^ 8a + |XJT) - AIXqI^ 


XqI^ + (aT)^ - 4a’ (X^ + Ix^jT) 


K 


K + 4 


= IXpi^) - IXpi^ 

(aT)^ - 2a (X^ + jx^lx) 


K 


K and ( , ) are calculated to be 0.594 and 0.129, respectively. Finally, 

K. *p h ' 

Figure 11 depicts the lateral Y, Z control logic which also has a ±5 
foot deadband modification. The control regions and thruster firing times 
are of the same format as that shown for range control. 


5.4 Phase 2 Control 

Phase 2 control begins at the stationkeeping state and ends at 
contact. For a minimum dispersion docking the following parameters and 
their derivatives need to be controlled; 

a) Range 

b) Lateral probe position errors 

c) Lateral c.g. position errors 

d) Relative roll 

e) Relative pitch and yaw 
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9 *10. 2 * Automatic' Docking Control Law (cont*d^ 
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9*10. 2 Automatic Docking Control Law (con't) 


5.5 Phase 2 Ran^s Control 

In addition to the obvious constraints ox maximum time to dock- 
ing and impact velocity, there may be other constraints; for example, 
jet plume impingement restrictions. However, until these later con- 
straints are defined, they will be neglected. 

The coordinate system used ‘is the TCS. The position error is 

given by 

X = R cos (6 + a)’ cos (4'- +-g) ■+ 5,cose‘ cosY„ - I 

^ R R 

* 

This quantity will be filtered to provide X. 

The .control law will basically be- the same as. the previously 
discussed time-fuel optimal logic with the addition of a rate limiting 
zone for coasting,' during the final "d" feet of the docking maneuver 
(see Figure 12). f^(X) is the curve dictated by two jet braking. K for 

^2^^^ can be determined by choosing a maximum time for reaching the. rate 

limiting logic for a worst case set of initial conditions. Selecting a 

* 

maximum time of 3 minutes and a worst case I.C. of X^ = .23 ft/sec and 
Xq = 150 feet, than K =0.2734 and ( - ^ = 0.06404. For this value 

of K, it can be shown that the maximum closing rate is less than '2 ft/ sec. 

The upper boundary in the rate limiting zone is set by the 
maximum impact velocity constraint which is assumed to be 0.1 ft/sec. 

The lower boundary is a function of maximum allowable time for coast 
and the distance for coast, d-. Assuming a 100 seconds and 5 feet, res- 
pectively, the lower limit is 0.05 ft/sec. 

There are three control regions. The first is the one lying to 
the right of the parabolic coast zone and above the rate limiting coast 
zone. Here the control should aim for a rate of 0.075 ft/sec (mid-way 
in rate ‘limiting zone) . 

t* — ^ • 0 7 5 

Region I ~ — — (5) 
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Figure 12 

Phase 2 Range Control Phase Plane 


9.10.2 Automatic Docking Control Law (c6nt*d) 



9.10.2 Automatic Docking Control Law (con*t) 


Region II lies to the left of the parabolic coast zone and the 
line X = - (d + . 1) . Control requirement for this region is to bring 
the state up to the lower parabolic switch line. Firing has been derived 
previously in a similar calculation. 


t 


Region II 


where X’ 






( 6 ) 


Finally, Region III lies to the right of the line X = -(d + .1) 
and below the rate limiting coast zone. The firing time is 


t 


Region III 


0.075 - X 
a 


(7) 


5.6 Control of Lateral Probe and C. G. Position Errors and 

Relative Pitch and Yaw Angles 

Lateral probe position error should be controlled directly be- 
cause the allowable lateral probe displacement at impact is likely to 
be quite small (one foot or less). Indirect control, by simply nulling 
c.g. position and relative pitch and yaw attitudes, can cause signi- 
ficant lateral dispersions (see reference) . However, as lateral probe 
position error is a function of lateral c.g. position errors and the 
relative pitch and yaw angles, the controls for all three must be co- 
ordinated. 

Considering the X-Z plane-first there are three pairs of vari- 
ables to be controlled (Z^^, (2^, Z^) and (0^, 9^). During this 

phase of control the two translational parameters will be calculated as 
follows in the TCS (see Figure 13). 

R sin (0j^ + a) + £ sin 6^ 

R sin (e + a) 
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ng 





9.10.2 Automatic Docking Control Law (con't) 


The respective rates will he obtained by a filtering routine to be 
determined. 



Intuitively, it can be seen that explicit control of any two of 
the variables (Z , Z , Sjj) ? implicitly controls the third. For example, 
a control which forces two of the variables into prescribed limit cycles, 
indirectly bounds the remaining variable into some limit cycle. As Z 

P 

has already been chosen as one of the variables to be controlled directly. 


it only remains to select either Z or 0„ for the other directly con- 

cg R ■ 

trolled variable. Either is acceptable: however, Z is chosen because 

eg 

Uq has five times more control authority than and by this choice 


can be used exclusively for control. Summarizing, at this point we 

have u_ for exclusive control of Z and £.u. for exclusive control of 
Z eg 6 

Z where u is a known disturbance of Z . In block diagram form, this 

pi p 

is represented as; 
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9.10.2 


Automatic Docking Control Law (con't) 


As an aid in defining the control, it is helpful to visualize 
the desired control state. "Realizing that there is a minimum control 
impulse on and 0^^ which necessitates deadbands. Figure 14 indicates 
the ideal control state. Effectively, we have located on the approach 
path with moving up and down in a deadband. Requirements for this 
condition are 




(2) Z = 0 
P 


A method of approximating this control state is to (I) drive (Z . Z ) 

^ eg ^ 

into a deadbanded limit cycle (consistent with allowable 6 range), 

(2) drive (Z^, Z^) into a very small deadband limit cycle, and (3) use 

differential jet firings to approach = 0 (i.e., take advantage of the 

small control impulse available from u - Au ) . 

Z 0 

A final consideration is that and Z should be within their 
deadbands before the range control has reached the rate limiting zone. 

As the maximum closing rate is 2 ft/sec, the minimum time for this is 
150/2 or 75 seconds. 


Switching logic for (Z , Z ) 

gs - ce 

The switching logic will have the same form as that used for 
Phase 1 except there will be a different deadband and value of K for 

the £ 2 ^^^ function. The deadband is dependent on the per axis allowable 
misalignment angle, y 

Hence, we have 

Z DEADBAND = Asiny 

eg 

Assuming a y of 2“ the Z deadband is 2.5 feet. To determine K, we 

eg ' 

insert T — 75 seconds and worst case initial conditions into the pre- 
viously derived formula 
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Figure 14 

Desired Control State 


9.10.2, Automatic Docking Control Law (contM) 



9.10.2 Automatic Docking Control Law (con't) 


^ _ 8a (Xq -f |Xq1t) - 4 jx^j^ 

IXfll^ + aV - 4aCXg + |ig|T) 

Assuming X^ = 10 ft and = -.25 ft/sec, K = .2265. However, as the 

value of K used for Phase 1 control, 0.594, is more conservative (i.e., 
longer hence quicker) it will be used for simplicity -of logic coding. 

A final modification from the Phase 1 logic is necessitated by the 
differential jet firing technique which will be used to null Z . It 

p 

requires the minimum delta V impulses available from the Z-translation 
and pitch jets to be the same. As u^ is approximately five times smaller 
than Ug, the minimum impulse from u^ must be increased proportionately. 
The control regions are the same as that previously used for lateral 
control. 


3.7 Switching logic for (Z , Z ) 

1 P P 

The control for Z^) will also be a modified form of the 

time - fuel- optimal switching logic. Figure 15 illustrates this logic. 
The linear acceleration from the pitch thrusters is five times greater 
than that from the translational thrusters, hence, for two thruster 
acceleration 




1 .'2 _ 1 • 2 
2a 2 


To determine K for the f 2 (Z^) function we must again revert back to the 
worst case initial conditions and maximum allowable' time -(this was chosen 
in the range control law to be 3 minutes) . Worst case initial conditions 
from the stationkeeping phase are shown in Figure 16. The position error 
is seen to be about -11 feet whereas velocity error is about -1.2 ft/sec 
(due to minimum impulse rates from translational and rotational control) . 
Usxng this I.C. , K is found to be 0.0575 and k/(K + 4) equals 0.0142. These 
small values may be increased slightly because of the high sensitivity of 

function to a rate error in Z . The desired deadband as shown 

y 
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9.10.2 Automatic Docking Control Lav (contld) 



Figure 16 

Worst Cas,e Position I.C. 


-6 ft 
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9.10.2- Automatic Docking Control Law (con't) 


in Figure 15 is one foot. To account for thruster firings the phase 
plane is broken into several control regions, as illustrated in Figure 17, 
With no Z-thruster control disturbances, u^ , the firing times for Regions 

I, II, and III are calculated in the same manner as the other phase planes. 
Namely, 


■Region I 


^ = V- 

a 


X - .125 


“Region II 


^ X- 

a y '“K + 2^ a 


Region III = 


^ - X 


( 8 ) 

(9) 

( 10 ) 


However, in Regions I, II, and III, if a non-zero command is scheduled 

from the (Z , Z ) phase plane, and this would cause the (Z , Z ) state 

_ ® ® P P 

to diverge (because of disagreement in sign), then this command is 

treated as a disturbance and the (Z^, Z^) firing time is increased pro- 
portionately for opposing commands 

^Region I, II “ ^Region I, II 5 ^(Z, Z) 

However, as the net acceleration during this disturbance period is re- 
duced by 20 percent, convergence time in the phase plane may be increased. 
If this proves a significant f actor, K will be Increased. Commands in 
the proper direction are not compensated for as this would cause chatter- 
ing during long Z firing times. In Region III a connnand in either 
direction should be compensated for 


•*^Region III ^Region III " 5 ^(Z,Z) 
as the desired control action is to drive the rate to zero. 

Finally, in Region IV, no control action is taken unless there 
is a command; then the desired control action is to drive the rate to 
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Figure 17 

« 

Z‘, Z Control- Regions 
P P ^ • 
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9.10.2 Automatic Docking Control Law' (con’ t) 


zero through, differential jet firings. The firing time equation is 


S "Z *(Z,Z) “ ^'^0 ^(Z , Z ) = 0 

P P 


Hence, the 'sign of the control is given by 


slgn,(*Ug) - (Zp + z)) 


(13) 


The firing time by 


tppgiopIV “ Z) 

/“e 


(14) 


A dual relation exists for control in the X-Y plane (see 
Figure 18)1 The- position errors, are 


■ Y =■ -R.sin (W + 8)'- £sin^_ 
eg • R ' R 


Y = -R sin ('1' + 8) 

P • - R 


Applicable control accelerations are 




eg 


Uy 


R 




The desired end condition requires ' 


(1) Y + JIT = 0 

eg R 


(2) Yp, Yp . 0 
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9.10.2 Automatic Docking Control Law (con’t)' 


The switching logic is identical except for Region IV where the 
sign of the control effort is given hy 

Sign (5-u^) = -sign t^^^ (15) 

and the firing time is given by 

^Region IV 

5.8 Relative Roll Control 

Relative roll control will be the same as that used in Phase 1 
except that the deadband will be reduced to comply with docking con- 
straints and close-in measurement accuracies. Two degrees will be 
assumed initially. 

6. Detailed Flow Diagrams 

This section contains the flow diagrams for the Automatic 
Docking Control Law. 


\ ^ Y) 

"Jlu,., 


(16) 
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9.10.2 Automatic Docking Control Law (con’t) 
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9.10.2 Automatic Docking Control -Law (con’-t) 
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9.10.2 Automatic Docking Control Law (con’t) 
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9.10.2 Automatic Docking Control Law (con't) 
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9.10.2 Automatic Docking Control Law (con’t) 
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9. 10.. 2 Automatic Docking Control Lavj (con't) 



tSCV.6 'T\VAt 


CL^UCUUP>.XC 

\ w \'riK\.\ZKTve»vj 


DAP 


9.10-84 















9.10. 2 , Automatic Docking Control Law (con't) 
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9.10.2 Automatic Docking Control Law (con't) 
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9.10.2 Automatic Docking Control Law (cont*d) 

Reference ' 

EG 2-70-149, "Docking Sensor Error Model," dated 16 September 
1970. 
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9.11- DOCKED OPERATIONS 

- The GN&C functions during docked operations are undefined. 
Some of the candidate functions are the following: 

1. Targeting for Rendezvous, Deorbit, Orbit 
modification, 

2. Absolute and Relative Navigation. 

3. Provide Guided AV's to the Space Station. 

4. Attitude Control of the docked cluster. 

5. Sensor Calibration and Alignment. 

6. System Monitor, Test and Checkout. 
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APPENDIX A 

APPICABLE APOLLO SOFTWARE 


The concepts represented by portions of the Apollo on-board 
software have been designated as being applicable to the Shuttle Onboard 
Software. These applicable Apollo concepts identified in the references 
below represent a foundation on which to develop shuttle software: 

Guidance System Operations Plan for Manned CM Earth 
Orbital and Lunar Missions Using Program. COLOSSUS 2E 
Section 5. Guidance Equations (Rev. 12) 

P30 - External AV Maneuver Guidance pg. 5.3-17 

P51 - IMU Orientation Determination pg. 5.6-2 

P52 - IMU Realignment Program pg. 5,6-6 


A-1 


NASA MSC 



